diff --git a/usb-loader/Makefile b/usb-loader/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..6cb40ce9210f9a2fc857961ecc0fb6d419bcbdcc
--- /dev/null
+++ b/usb-loader/Makefile
@@ -0,0 +1,9 @@
+CC=gcc
+OBJS=mch_flasher.o serial_linux.o
+OUTPUT=mch_flasher
+
+all:	$(OBJS)
+		${CC} -o $(OUTPUT) $(OBJS)
+
+clean:
+		rm -f $(OBJS) $(OUTPUT)
\ No newline at end of file
diff --git a/usb-loader/applet.h b/usb-loader/applet.h
new file mode 100644
index 0000000000000000000000000000000000000000..60ba37cc246a1c74a0047bc58416b6385ee41824
--- /dev/null
+++ b/usb-loader/applet.h
@@ -0,0 +1,97 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+#ifndef APPLET_H
+#define APPLET_H
+
+//------------------------------------------------------------------------------
+//         Global definitions
+//------------------------------------------------------------------------------
+
+/// Refers to the Version of SAM-BA
+#define SAM_BA_APPLETS_VERSION  "2.9"
+
+/// Applet initialization command code.
+#define APPLET_CMD_INIT              0x00
+/// Applet full erase command code.
+#define APPLET_CMD_FULL_ERASE        0x01
+/// Applet write command code.
+#define APPLET_CMD_WRITE             0x02
+/// Applet read command code.
+#define APPLET_CMD_READ              0x03
+/// Applet read command code.
+#define APPLET_CMD_LOCK              0x04
+/// Applet read command code.
+#define APPLET_CMD_UNLOCK            0x05
+/// Applet set/clear GPNVM command code.
+#define APPLET_CMD_GPNVM             0x06
+/// Applet set security bit command code.
+#define APPLET_CMD_SECURITY          0x07
+/// Applet buffer erase command code.
+#define APPLET_CMD_BUFFER_ERASE      0x08
+/// Applet binary page command code for Dataflash.
+#define APPLET_CMD_BINARY_PAGE       0x09
+/// List Bad Blocks of a Nandflash
+#define APPLET_CMD_LIST_BAD_BLOCKS   0x10
+/// Tag a Nandflash Block
+#define APPLET_CMD_TAG_BLOCK         0x11
+/// Read the Unique ID bits (on SAM3)
+#define APPLET_CMD_READ_UNIQUE_ID    0x12
+
+/// Operation was successful.
+#define APPLET_SUCCESS          0x00
+/// Device unknown.
+#define APPLET_DEV_UNKNOWN      0x01
+/// Write operation failed.
+#define APPLET_WRITE_FAIL       0x02
+/// Read operation failed.
+#define APPLET_READ_FAIL        0x03
+/// Protect operation failed.
+#define APPLET_PROTECT_FAIL     0x04
+/// Unprotect operation failed.
+#define APPLET_UNPROTECT_FAIL   0x05
+/// Erase operation failed.
+#define APPLET_ERASE_FAIL       0x06
+/// No device defined in board.h
+#define APPLET_NO_DEV           0x07
+/// Read / write address is not aligned
+#define APPLET_ALIGN_ERROR      0x08
+/// Read / write found bad block
+#define APPLET_BAD_BLOCK        0x09
+/// Applet failure.
+#define APPLET_FAIL             0x0f
+
+
+/// Communication link identification
+#define USB_COM_TYPE            0x00
+#define DBGU_COM_TYPE           0x01
+#define JTAG_COM_TYPE           0x02
+
+#endif //#ifndef APPLET_H
+
diff --git a/usb-loader/mch_flasher.c b/usb-loader/mch_flasher.c
new file mode 100644
index 0000000000000000000000000000000000000000..b1c08787dcbc424fa336c3cced71ae3c6a48e33b
--- /dev/null
+++ b/usb-loader/mch_flasher.c
@@ -0,0 +1,440 @@
+/* V3 Flasher - temporary version */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <stdarg.h>
+#include <string.h>
+
+#include <libgen.h>
+
+#include <inttypes.h>
+
+#include "serial.h"
+#include "applet.h"
+
+#define BOARD_REV_V2 2
+#define BOARD_REV_V3 3
+
+
+#define ID_SAM9263 0x019607A2
+#define ID_SAM9G45 0x819b05a2
+#define SERIAL_TIMEOUT 10000000
+
+#define MBOX_COMMAND 			0x4
+#define MBOX_STATUS 			0x8
+#define MBOX_COMTYPE			0xc
+#define MBOX_TRACELEVEL			0x10
+#define MBOX_EXTRAM_VDDMEM		0x14
+#define MBOX_EXTRAM_RAMTYPE		0x18
+#define MBOX_EXTRAM_BUSWIDTH	0x1c
+#define MBOX_EXTRAM_DDRMODEL	0x20
+#define MBOX_DATAFLASH_INDEX	0x14
+#define MBOX_DATAFLASH_BUFFER_ADDR	0x10
+#define MBOX_PROG_BUF_SIZE	0x
+
+#define MBOX_DATAFLASH_BUF_ADDR 0xc
+#define MBOX_DATAFLASH_BUF_SIZE 0x10
+#define MBOX_DATAFLASH_MEM_OFFSET 0x14
+
+#define INTERNAL_SRAM_BUF 		0x300000
+#define SDRAM_START 			0x70000000
+
+
+#define PORT_SPEED 			115200
+
+char *program_path;
+
+int applet_silent_mode = 1;
+
+unsigned int buffer_size = 0x3000;
+unsigned int buffer_addr ;
+
+int crc16(int value, int crcin)
+{
+    int k = (((crcin >> 8) ^ value) & 255) << 8;
+    int crc = 0;
+    int bits = 8;
+    do
+    {
+        if (( crc ^ k ) & 0x8000)
+            crc = (crc << 1) ^ 0x1021;
+        else
+            crc <<= 1;
+        k <<= 1;
+    }
+    while (--bits);
+    return ((crcin << 8) ^ crc);
+}
+
+
+static int write_xmodem(int index, char *p)
+{
+    unsigned char data[133],c;
+    unsigned short crc=0;
+    int i;
+    data[0]=1;
+    data[1]=index;
+    data[2]=0xff-index;
+
+    memcpy(data+3,p,128);
+    for(i=3;i<131;i++){
+     crc=crc16(data[i],crc);
+    }
+    data[131] = (crc>>8)&0xff;
+    data[132] = (crc)&0xff;
+    printf("XMDump: ");
+    for(i=0;i<133;i++) printf("%02x ", data[i]);
+    printf("\n\n");
+    serial_write(data,133);
+    return serial_read_byte();
+}
+
+
+void die(const char *fmt, ...)
+{
+	va_list ap;
+	
+	va_start(ap, fmt);
+	fprintf(stderr, "Error: ");
+	vfprintf(stderr, fmt, ap);
+	fprintf(stderr, "\n\n");
+	va_end(ap);
+	exit(-1);
+}
+
+
+
+void samba_write (uint32_t addr, uint32_t data, int size, int timeout)
+{
+	char tmpbuf[1024],c;
+	uint32_t tstart;
+
+	serial_purge();
+	snprintf(tmpbuf, 1024, "%c%08x,%08x#", size==1?'O':(size==2?'H':'W'), addr, data);
+	serial_write(tmpbuf, strlen(tmpbuf));
+
+    tstart = sys_get_clock_usec();
+
+	while(1)
+	{
+	  if(serial_data_avail())
+	  {		
+		if(serial_read_byte() =='>') break;
+	  }
+	  if(sys_get_clock_usec() - tstart > timeout) die("tx timeout");
+	}
+  
+
+  
+
+}
+
+
+uint32_t samba_read (uint32_t addr, int size, int timeout)
+{
+	char tmpbuf[1024],c=0;
+	int i,xpos=-1;
+	uint32_t rval;
+	uint32_t tstart;
+	
+	serial_purge();
+	snprintf(tmpbuf, 1024, "%c%08x,#", size==1?'o':(size==2?'h':'w'), addr);
+	
+//	printf("--> cmd: '%s'\n", tmpbuf);
+
+	serial_write(tmpbuf, strlen(tmpbuf));
+
+    tstart = sys_get_clock_usec();
+
+	for(i=0;i<1024 && c!='>';) 
+	{ 
+	  if(serial_data_avail())
+	  {		
+		tmpbuf[i]=c=serial_read_byte();
+//		fprintf(stderr,"%c", c);
+		if(c=='x') xpos=i; 
+		i++;
+	  }
+
+    if(sys_get_clock_usec()-tstart>timeout) die("rx timeout");
+	  
+	}
+	
+	if(xpos<0) die("invalid response from samba");
+	
+	sscanf(tmpbuf, "%x", &rval);
+//	fprintf(stderr,"samba_read: %x\n", rval);
+	return rval;	
+}
+
+
+static int samba_send_file(const char *filename, uint32_t address, uint32_t offset, uint32_t size, int quiet)
+{
+  FILE *f;
+  unsigned char *buf;
+  uint32_t file_size, sent;
+  int idx = 0;
+  int boffset = 0;
+  char tmp[4097];
+
+  uint32_t tstart;
+    
+//    printf("SendFile: %s\n", filename);
+    
+  f = fopen(filename, "rb");
+  if(!f) die("file open error: '%s'",filename);
+  
+  
+  if(!size)
+  {
+	fseek(f, 0, SEEK_END);
+    size = ftell(f);
+    offset = 0;
+	rewind(f);
+  } else 
+	fseek(f, offset, SEEK_SET);
+
+  buf = malloc(size+1);
+  if(!buf) die("malloc failed");
+  
+  fread(buf, 1, size, f);
+  fclose(f);
+
+//    printf("Send: %s\n", filename);
+
+    while(size > 0)
+    {
+      int tosend = size > 1024 ? 1024 : size;
+//      printf("Sending %d bytes\n", tosend);
+
+      snprintf(tmp, 128, "S%08x,%x#", address, tosend);
+      serial_write(tmp, strlen(tmp));
+      memcpy(tmp, buf + boffset, tosend);
+      tmp[tosend]='\n';
+      serial_write(tmp, tosend+1);
+      
+      size -= tosend;
+      boffset +=tosend;
+      address += tosend;
+
+      while(1)
+      {	
+        if(serial_data_avail()) 
+	    if(serial_read_byte() == '>')
+		break;
+      }
+    }
+
+  free(buf);
+
+  return boffset;
+
+}
+
+static void samba_load_applet(char *applet_name, uint32_t address)
+{
+	char namebuf[1024];
+
+	printf("loading applet %s at 0x%08x\n", applet_name, address);
+	
+	snprintf(namebuf, 1024, "%s/samba_applets/%s.bin", program_path, applet_name);
+	samba_send_file(namebuf, address, 0, 0, 1);
+}
+
+
+static void mbox_write(uint32_t base, uint32_t offset, uint32_t value)
+{
+  samba_write(base+offset, value, 4, SERIAL_TIMEOUT);
+}	
+
+void samba_run(uint32_t addr, int timeout)
+{
+	char tmpbuf[1024],c;
+	uint32_t tstart,t1;
+
+	serial_purge();
+	snprintf(tmpbuf, 1024, "G%08x#",  addr);
+
+	serial_write(tmpbuf, strlen(tmpbuf));
+	
+	t1 = tstart = sys_get_clock_usec();
+	
+	while((timeout && (sys_get_clock_usec()- tstart < timeout)) || !timeout)
+	{
+	  if(serial_data_avail()) {
+		c = serial_read_byte();
+		if(c == '>') break;
+	    if(!applet_silent_mode )fprintf(stderr,"%c", c);
+	    t1 = sys_get_clock_usec();
+  	  } else if(sys_get_clock_usec() - t1 > 10000)
+	  {
+	//	fprintf(stderr,"Phase1\n");
+
+//		serial_write_byte('\n');
+		serial_write_byte(0x0a);
+		serial_write_byte(0x0d);
+		serial_write_byte('T');
+		serial_write_byte('#');
+		serial_write_byte(0x0a);
+		serial_write_byte(0x0d);
+		usleep(10000);
+		while(serial_data_avail())
+		{
+		  c=serial_read_byte();
+		  if( c == '>') 
+    		    return; 
+  		  else if(!applet_silent_mode)
+			fprintf(stderr,"%c", c);
+		}
+	  }
+	}
+}
+
+
+
+int samba_connect(int board_rev)
+{
+    char handshake[] = {0x80, 0x80, 0x23}, cmd[128], buffer[16384];
+    int tstart,i,length,npages;
+	int c;
+
+
+
+	serial_write(handshake,3);
+	sys_delay(100);
+
+	uint32_t id = samba_read(0xffffee40, 4, SERIAL_TIMEOUT);
+	
+	printf("CPU ID: 0x%08x\n",id);
+
+	if(board_rev == BOARD_REV_V2 && id != ID_SAM9263) die ("Not a 9263 CPU");
+	if(board_rev == BOARD_REV_V3 && id != ID_SAM9G45) die ("Not a 9G45 CPU");
+
+	if(board_rev == BOARD_REV_V2)
+		samba_load_applet("isp-extram-at91sam9263", INTERNAL_SRAM_BUF);
+	else if(board_rev == BOARD_REV_V3)
+		samba_load_applet("isp-extram-at91sam9g45", INTERNAL_SRAM_BUF);
+
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_COMMAND, APPLET_CMD_INIT);
+
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_TRACELEVEL, 0);
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_EXTRAM_RAMTYPE, 1);
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_EXTRAM_VDDMEM, 0);
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_EXTRAM_BUSWIDTH, 16);
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_EXTRAM_DDRMODEL, 0);
+
+	samba_run(INTERNAL_SRAM_BUF, 100000000);
+
+	if((samba_read(INTERNAL_SRAM_BUF + MBOX_COMMAND, 4, 10000000)) != ~APPLET_CMD_INIT) die("invalid response from applet");
+	if((samba_read(INTERNAL_SRAM_BUF + MBOX_STATUS, 4, 10000000)) != APPLET_SUCCESS) die("invalid response from applet");
+
+	return 0;
+}
+
+int dataflash_init(int board_rev)
+{
+
+//	samba_write(0xfffff410, 0x04000000, 4, 100000);
+//	samba_write(0xfffff430, 0x04000000, 4, 100000);
+	
+	if(board_rev == BOARD_REV_V2)
+		samba_load_applet("isp-dataflash-at91sam9263", INTERNAL_SRAM_BUF);
+	else if(board_rev == BOARD_REV_V3)
+		samba_load_applet("isp-dataflash-at91sam9g45", INTERNAL_SRAM_BUF);
+//	samba_load_applet("isp-dataflash-at91sam9263", SDRAM_START);
+
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_COMMAND, APPLET_CMD_INIT);
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_COMTYPE, 1);
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_TRACELEVEL, 4);
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_DATAFLASH_INDEX, 0);
+
+	samba_run(INTERNAL_SRAM_BUF, 0);
+
+	if(samba_read(INTERNAL_SRAM_BUF + MBOX_COMMAND, 4, 10000000) != ~APPLET_CMD_INIT) die("invalid response from applet");
+	if(samba_read(INTERNAL_SRAM_BUF + MBOX_STATUS, 4, 10000000) != APPLET_SUCCESS) die(" DataFlash initialization failure (no chip deteted?)");
+
+	buffer_addr = samba_read(INTERNAL_SRAM_BUF + MBOX_DATAFLASH_BUFFER_ADDR, 4, 10000000);
+//	fprintf(stderr,"DF Initialized");
+	return 0;
+}
+
+
+
+
+int dataflash_write(uint32_t offset, uint32_t buf_addr, uint32_t size)
+{
+
+    applet_silent_mode=0;
+    fprintf(stderr, "Dataflash: Writing %d bytes at offset 0x%x buffer %x....", size, offset, buf_addr);
+    mbox_write(INTERNAL_SRAM_BUF, MBOX_DATAFLASH_BUF_ADDR, buf_addr);
+    fprintf(stderr,"A");
+    mbox_write(INTERNAL_SRAM_BUF, MBOX_DATAFLASH_BUF_ADDR, buf_addr);
+    fprintf(stderr,"B");
+    mbox_write(INTERNAL_SRAM_BUF, MBOX_DATAFLASH_BUF_SIZE, size);
+    fprintf(stderr,"C");
+    mbox_write(INTERNAL_SRAM_BUF, MBOX_DATAFLASH_MEM_OFFSET, offset);
+    fprintf(stderr,"D");
+
+    mbox_write(INTERNAL_SRAM_BUF, MBOX_COMMAND, APPLET_CMD_WRITE);
+    fprintf(stderr,"E");
+	
+    samba_run(INTERNAL_SRAM_BUF, 0);
+    fprintf(stderr,"F");
+
+	if(samba_read(INTERNAL_SRAM_BUF + MBOX_COMMAND, 4, 10000000) != ~APPLET_CMD_WRITE) die(" invalid response from applet");
+	if(samba_read(INTERNAL_SRAM_BUF + MBOX_STATUS, 4, 10000000) != APPLET_SUCCESS) die(" write failure");
+
+
+	printf("done. \n\n");
+
+  
+}
+
+int dataflash_erase_all()
+{
+	mbox_write(INTERNAL_SRAM_BUF, MBOX_COMMAND, APPLET_CMD_FULL_ERASE);
+	samba_run(INTERNAL_SRAM_BUF, 0);
+}
+
+int dataflash_program(const char *filename)
+{
+	uint32_t len = samba_send_file(filename, SDRAM_START, 0, 0, 0);
+	dataflash_write(0, SDRAM_START, len);
+}
+
+main(int argc, char *argv[])
+{
+	int board_rev  = BOARD_REV_V3;
+	char *serial_port = "/dev/ttyACM0";
+
+	
+	if(argc < 2)
+	{
+	  printf("WhiteRabbit MCH DataFlash programmer (c) T.W. 2010\n");
+	  printf("Usage: %s <dataflash image> [serial port (default = %s)\n", argv[0], serial_port);
+	  return 0;
+	}
+	
+	if(argc > 2)
+	  serial_port = argv[2];
+
+
+	program_path = dirname(argv[0]);
+
+	serial_open(serial_port, PORT_SPEED);
+	fprintf(stderr,"Initializing SAM-BA: ");
+	samba_connect(board_rev);
+
+	fprintf(stderr,"Initializing DataFlash...\n\n");
+	dataflash_init(board_rev);
+
+//	dataflash_erase_all();
+	
+	fprintf(stderr,"Programming DataFlash...\n");
+	dataflash_program(argv[1]);
+	printf("Programming done!\n");
+
+  serial_close();
+    
+  return 0;
+}
\ No newline at end of file
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/AT91SAM9G45.h b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/AT91SAM9G45.h
new file mode 100644
index 0000000000000000000000000000000000000000..03352f87d57db918f6bc14f9e26a2f1b4bb9a504
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/AT91SAM9G45.h
@@ -0,0 +1,7068 @@
+//  ----------------------------------------------------------------------------
+//          ATMEL Microcontroller Software Support  -  ROUSSET  -
+//  ----------------------------------------------------------------------------
+//  Copyright (c) 2009, Atmel Corporation
+// 
+//  All rights reserved.
+// 
+//  Redistribution and use in source and binary forms, with or without
+//  modification, are permitted provided that the following conditions are met:
+// 
+//  - Redistributions of source code must retain the above copyright notice,
+//  this list of conditions and the disclaimer below.
+// 
+//  Atmel's name may not be used to endorse or promote products derived from
+//  this software without specific prior written permission. 
+//  
+//  DISCLAIMER:  THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+//  IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+//  MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+//  DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+//  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+//  LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+//  OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+//  LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+//  NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+//  EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+//  ----------------------------------------------------------------------------
+// File Name           : AT91SAM9G45.h
+// Object              : AT91SAM9G45 definitions
+// Generated           : AT91 SW Application Group  03/29/2010 (13:16:47)
+// 
+// CVS Reference       : /AT91SAM9G45.pl/1.1/Wed May 20 12:05:51 2009//
+// CVS Reference       : /SYS_SAM9264.pl/1.2/Tue Oct  2 12:19:30 2007//
+// CVS Reference       : /HMATRIX2_SAM9G45.pl/1.1/Wed May 20 09:31:20 2009//
+// CVS Reference       : /PMC_SAM9264.pl/1.9/Thu Nov 29 09:55:11 2007//
+// CVS Reference       : /HDDRSDRC2_6304B.pl/1.5/Fri Mar 12 10:40:41 2010//
+// CVS Reference       : /EBI_SAM9260.pl/1.1/Fri Sep 30 12:12:14 2005//
+// CVS Reference       : /HSMC3_SAM9264.pl/1.1/Wed Oct 10 09:39:31 2007//
+// CVS Reference       : /HECC_6143A.pl/1.1/Wed Feb  9 17:16:57 2005//
+// CVS Reference       : /SFR_SAM9264.pl/1.4/Fri Feb 29 14:02:55 2008//
+// CVS Reference       : /AIC_6075A.pl/1.1/Mon Jul 12 17:04:01 2004//
+// CVS Reference       : /PDC_6074C.pl/1.2/Thu Feb  3 09:02:11 2005//
+// CVS Reference       : /DBGU_6059D.pl/1.2/Mon Mar 29 11:07:19 2010//
+// CVS Reference       : /PIO_SAM9264.pl/1.1/Wed Oct 10 09:38:26 2007//
+// CVS Reference       : /RSTC_6098A.pl/1.4/Fri Oct 17 13:27:55 2008//
+// CVS Reference       : /SHDWC_6122A.pl/1.3/Wed Oct  6 14:16:58 2004//
+// CVS Reference       : /RTTC_6081A.pl/1.2/Thu Nov  4 13:57:22 2004//
+// CVS Reference       : /PITC_6079A.pl/1.2/Thu Nov  4 13:56:22 2004//
+// CVS Reference       : /WDTC_6080A.pl/1.3/Thu Nov  4 13:58:52 2004//
+// CVS Reference       : /TC_6082A.pl/1.8/Fri Oct 17 13:27:58 2008//
+// CVS Reference       : /MCI_6101F.pl/1.3/Fri Jan 23 09:15:32 2009//
+// CVS Reference       : /TWI_6061B.pl/1.3/Fri Oct 17 13:27:59 2008//
+// CVS Reference       : /US_6089S.pl/1.1/Mon Mar 29 11:03:23 2010//
+// CVS Reference       : /SSC_6078B.pl/1.3/Fri Oct 17 13:27:57 2008//
+// CVS Reference       : /SPI_6088D.pl/1.3/Fri May 20 14:23:02 2005//
+// CVS Reference       : /AC97C_XXXX.pl/1.3/Tue Feb 22 17:08:27 2005//
+// CVS Reference       : /PWM_6044D.pl/1.2/Tue May 10 12:39:09 2005//
+// CVS Reference       : /LCDC_6063A.pl/1.6/Tue Jan 20 16:29:59 2009//
+// CVS Reference       : /HDMA_SAM9264.pl/1.2/Thu Sep 13 11:48:30 2007//
+// CVS Reference       : /UDPHS_SAM9_7ept6dma4iso.pl/1.4/Tue Jun 24 13:05:14 2008//
+// CVS Reference       : /TSC_SAM9264.pl/1.2/Thu Jun 25 08:43:26 2009//
+// CVS Reference       : /RTC_1245D.pl/1.3/Fri Sep 17 14:01:31 2004//
+// CVS Reference       : /EMACB_SAM9264.pl/1.1/Tue Sep 25 12:07:23 2007//
+// CVS Reference       : /uhphs_ohci.pl/1.1/Fri Jun 22 14:20:34 2007//
+// CVS Reference       : /uhphs_ehci.pl/1.3/Tue Jul 17 07:50:29 2007//
+// CVS Reference       : /ISI_SAM9264.pl/1.2/Wed Sep  3 08:30:55 2008//
+// CVS Reference       : /TRNG_xxxxx.pl/1.1/Wed Jul 18 12:02:58 2007//
+//  ----------------------------------------------------------------------------
+
+#ifndef AT91SAM9G45_H
+#define AT91SAM9G45_H
+
+#ifndef __ASSEMBLY__
+typedef volatile unsigned int AT91_REG;// Hardware register definition
+#define AT91_CAST(a) (a)
+#else
+#define AT91_CAST(a)
+#endif
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR SPECIAL FUNCTION REGISTER
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_SFR {
+	AT91_REG	 SFR_EMA; 	// memory Extra Margin Adjustment control
+	AT91_REG	 SFR_DDRCFG; 	// DDR2 SSTL18 control
+	AT91_REG	 SFR_DDRDELAY; 	// DDR2 controller clock delay
+	AT91_REG	 SFR_EBIDELAY; 	// EBI DDR controller clock delay
+	AT91_REG	 SFR_UTMICFG; 	// UTMI Software Reset, and OHCI suspend interrupt control
+	AT91_REG	 SFR_INT; 	// OHCI suspend Interrupt status
+} AT91S_SFR, *AT91PS_SFR;
+#else
+#define SFR_EMA         (AT91_CAST(AT91_REG *) 	0x00000000) // (SFR_EMA) memory Extra Margin Adjustment control
+#define SFR_DDRCFG      (AT91_CAST(AT91_REG *) 	0x00000004) // (SFR_DDRCFG) DDR2 SSTL18 control
+#define SFR_DDRDELAY    (AT91_CAST(AT91_REG *) 	0x00000008) // (SFR_DDRDELAY) DDR2 controller clock delay
+#define SFR_EBIDELAY    (AT91_CAST(AT91_REG *) 	0x0000000C) // (SFR_EBIDELAY) EBI DDR controller clock delay
+#define SFR_UTMICFG     (AT91_CAST(AT91_REG *) 	0x00000010) // (SFR_UTMICFG) UTMI Software Reset, and OHCI suspend interrupt control
+#define SFR_OHCI_SUSP_INT (AT91_CAST(AT91_REG *) 	0x00000014) // (SFR_OHCI_SUSP_INT) OHCI suspend Interrupt status
+
+#endif
+// -------- SFR_EMA : (SFR Offset: 0x0) memory Extra Margin Adjustment control register -------- 
+#define AT91C_SFR_RAM_EMA     (0x7 <<  0) // (SFR) SRAM EMA
+#define 	AT91C_SFR_RAM_EMA_0                    (0x0) // (SFR) Normal Mode
+#define 	AT91C_SFR_RAM_EMA_1                    (0x1) // (SFR) DEBUG MODE 1
+#define 	AT91C_SFR_RAM_EMA_2                    (0x2) // (SFR) DEBUG MODE 2
+#define 	AT91C_SFR_RAM_EMA_3                    (0x3) // (SFR) DEBUG MODE 3
+#define 	AT91C_SFR_RAM_EMA_4                    (0x4) // (SFR) DEBUG MODE 4
+#define 	AT91C_SFR_RAM_EMA_5                    (0x5) // (SFR) DEBUG MODE 5
+#define 	AT91C_SFR_RAM_EMA_6                    (0x6) // (SFR) DEBUG MODE 6
+#define 	AT91C_SFR_RAM_EMA_7                    (0x7) // (SFR) DEBUG MODE 7
+#define AT91C_SFR_DPRAM_EMA   (0x7 <<  4) // (SFR) SRAM EMA
+#define 	AT91C_SFR_DPRAM_EMA_0                    (0x0 <<  4) // (SFR) Normal Mode
+#define 	AT91C_SFR_DPRAM_EMA_1                    (0x1 <<  4) // (SFR) DEBUG MODE 1
+#define 	AT91C_SFR_DPRAM_EMA_2                    (0x2 <<  4) // (SFR) DEBUG MODE 2
+#define 	AT91C_SFR_DPRAM_EMA_3                    (0x3 <<  4) // (SFR) DEBUG MODE 3
+#define 	AT91C_SFR_DPRAM_EMA_4                    (0x4 <<  4) // (SFR) DEBUG MODE 4
+#define 	AT91C_SFR_DPRAM_EMA_5                    (0x5 <<  4) // (SFR) DEBUG MODE 5
+#define 	AT91C_SFR_DPRAM_EMA_6                    (0x6 <<  4) // (SFR) DEBUG MODE 6
+#define 	AT91C_SFR_DPRAM_EMA_7                    (0x7 <<  4) // (SFR) DEBUG MODE 7
+#define AT91C_SFR_RF_EMA      (0x7 <<  8) // (SFR) SRAM EMA
+#define 	AT91C_SFR_RF_EMA_0                    (0x0 <<  8) // (SFR) Normal Mode
+#define 	AT91C_SFR_RF_EMA_1                    (0x1 <<  8) // (SFR) DEBUG MODE 1
+#define 	AT91C_SFR_RF_EMA_2                    (0x2 <<  8) // (SFR) DEBUG MODE 2
+#define 	AT91C_SFR_RF_EMA_3                    (0x3 <<  8) // (SFR) DEBUG MODE 3
+#define 	AT91C_SFR_RF_EMA_4                    (0x4 <<  8) // (SFR) DEBUG MODE 4
+#define 	AT91C_SFR_RF_EMA_5                    (0x5 <<  8) // (SFR) DEBUG MODE 5
+#define 	AT91C_SFR_RF_EMA_6                    (0x6 <<  8) // (SFR) DEBUG MODE 6
+#define 	AT91C_SFR_RF_EMA_7                    (0x7 <<  8) // (SFR) DEBUG MODE 7
+#define AT91C_SFR_DPRF_EMA    (0x7 << 12) // (SFR) SRAM EMA
+#define 	AT91C_SFR_DPRF_EMA_0                    (0x0 << 12) // (SFR) Normal Mode
+#define 	AT91C_SFR_DPRF_EMA_1                    (0x1 << 12) // (SFR) DEBUG MODE 1
+#define 	AT91C_SFR_DPRF_EMA_2                    (0x2 << 12) // (SFR) DEBUG MODE 2
+#define 	AT91C_SFR_DPRF_EMA_3                    (0x3 << 12) // (SFR) DEBUG MODE 3
+#define 	AT91C_SFR_DPRF_EMA_4                    (0x4 << 12) // (SFR) DEBUG MODE 4
+#define 	AT91C_SFR_DPRF_EMA_5                    (0x5 << 12) // (SFR) DEBUG MODE 5
+#define 	AT91C_SFR_DPRF_EMA_6                    (0x6 << 12) // (SFR) DEBUG MODE 6
+#define 	AT91C_SFR_DPRF_EMA_7                    (0x7 << 12) // (SFR) DEBUG MODE 7
+#define AT91C_SFR_ROM_EMA     (0x7 << 16) // (SFR) SRAM EMA
+#define 	AT91C_SFR_ROM_EMA_0                    (0x0 << 16) // (SFR) Normal Mode
+#define 	AT91C_SFR_ROM_EMA_1                    (0x1 << 16) // (SFR) DEBUG MODE 1
+#define 	AT91C_SFR_ROM_EMA_2                    (0x2 << 16) // (SFR) DEBUG MODE 2
+#define 	AT91C_SFR_ROM_EMA_3                    (0x3 << 16) // (SFR) DEBUG MODE 3
+#define 	AT91C_SFR_ROM_EMA_4                    (0x4 << 16) // (SFR) DEBUG MODE 4
+#define 	AT91C_SFR_ROM_EMA_5                    (0x5 << 16) // (SFR) DEBUG MODE 5
+#define 	AT91C_SFR_ROM_EMA_6                    (0x6 << 16) // (SFR) DEBUG MODE 6
+#define 	AT91C_SFR_ROM_EMA_7                    (0x7 << 16) // (SFR) DEBUG MODE 7
+// -------- SFR_DDRCFG : (SFR Offset: 0x4) DDR2 SSTL18 control register -------- 
+#define AT91C_SFR_DDRCFG_SSTL (0x1 <<  0) // (SFR) Control DDR2 pads SSTL mode control
+#define 	AT91C_SFR_DDRCFG_SSTL_NORMAL               (0x0) // (SFR) Force pads in SSTL18 mode when DDR2 is connected
+#define 	AT91C_SFR_DDRCFG_SSTL_COMPATIBLE           (0x1) // (SFR) LVCMOS level (compatible SSTL18)
+#define AT91C_SFR_DDRCFG_CLKDELAY (0x1 <<  8) // (SFR) Control DDR2 pads clocks delay on clk, dqs0, dqs1
+#define 	AT91C_SFR_DDRCFG_CLKDELAY_HARD                 (0x0 <<  8) // (SFR) Fixed by hardware
+#define 	AT91C_SFR_DDRCFG_CLKDELAY_SOFT                 (0x1 <<  8) // (SFR) Software must write correct delay value
+// -------- SFR_DDRDELAY : (SFR Offset: 0x8) DDR2 controller clock delay -------- 
+#define AT91C_SFR_DDRDELAY_CLK (0xFF <<  0) // (SFR) Control CLK clock delay
+#define 	AT91C_SFR_DDRDELAY_CLK_0                    (0x0) // (SFR) minimum delay
+#define 	AT91C_SFR_DDRDELAY_CLK_1                    (0x1) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_2                    (0x2) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_3                    (0x3) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_4                    (0x4) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_5                    (0x5) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_6                    (0x6) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_7                    (0x7) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_8                    (0x8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_9                    (0x9) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_10                   (0xA) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_11                   (0xB) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_12                   (0xC) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_13                   (0xD) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_14                   (0xE) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_15                   (0xF) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_CLK_16                   (0x10) // (SFR) 
+#define AT91C_SFR_DDRDELAY_DQS0 (0xFF <<  8) // (SFR) Control DQS0 clock delay
+#define 	AT91C_SFR_DDRDELAY_DQS0_0                    (0x0 <<  8) // (SFR) minimum delay
+#define 	AT91C_SFR_DDRDELAY_DQS0_1                    (0x1 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_2                    (0x2 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_3                    (0x3 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_4                    (0x4 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_5                    (0x5 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_6                    (0x6 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_7                    (0x7 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_8                    (0x8 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_9                    (0x9 <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_10                   (0xA <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_11                   (0xB <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_12                   (0xC <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_13                   (0xD <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_14                   (0xE <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_15                   (0xF <<  8) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS0_16                   (0x10 <<  8) // (SFR) 
+#define AT91C_SFR_DDRDELAY_DQS1 (0xFF << 16) // (SFR) Control DQS1 clock delay
+#define 	AT91C_SFR_DDRDELAY_DQS1_0                    (0x0 << 16) // (SFR) minimum delay
+#define 	AT91C_SFR_DDRDELAY_DQS1_1                    (0x1 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_2                    (0x2 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_3                    (0x3 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_4                    (0x4 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_5                    (0x5 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_6                    (0x6 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_7                    (0x7 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_8                    (0x8 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_9                    (0x9 << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_10                   (0xA << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_11                   (0xB << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_12                   (0xC << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_13                   (0xD << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_14                   (0xE << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_15                   (0xF << 16) // (SFR) 
+#define 	AT91C_SFR_DDRDELAY_DQS1_16                   (0x10 << 16) // (SFR) 
+// -------- SFR_EBIDELAY : (SFR Offset: 0xc) EBI DDR controller clock delay -------- 
+#define AT91C_SFR_EBIDELAY_CLK (0xFF <<  0) // (SFR) Control CLK clock delay
+#define 	AT91C_SFR_EBIDELAY_CLK_0                    (0x0) // (SFR) minimum delay
+#define 	AT91C_SFR_EBIDELAY_CLK_1                    (0x1) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_2                    (0x2) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_3                    (0x3) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_4                    (0x4) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_5                    (0x5) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_6                    (0x6) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_7                    (0x7) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_8                    (0x8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_9                    (0x9) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_10                   (0xA) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_11                   (0xB) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_12                   (0xC) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_13                   (0xD) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_14                   (0xE) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_15                   (0xF) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_CLK_16                   (0x10) // (SFR) 
+#define AT91C_SFR_EBIDELAY_DQS0 (0xFF <<  8) // (SFR) Control DQS0 clock delay
+#define 	AT91C_SFR_EBIDELAY_DQS0_0                    (0x0 <<  8) // (SFR) minimum delay
+#define 	AT91C_SFR_EBIDELAY_DQS0_1                    (0x1 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_2                    (0x2 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_3                    (0x3 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_4                    (0x4 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_5                    (0x5 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_6                    (0x6 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_7                    (0x7 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_8                    (0x8 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_9                    (0x9 <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_10                   (0xA <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_11                   (0xB <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_12                   (0xC <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_13                   (0xD <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_14                   (0xE <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_15                   (0xF <<  8) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS0_16                   (0x10 <<  8) // (SFR) 
+#define AT91C_SFR_EBIDELAY_DQS1 (0xFF << 16) // (SFR) Control DQS1 clock delay
+#define 	AT91C_SFR_EBIDELAY_DQS1_0                    (0x0 << 16) // (SFR) minimum delay
+#define 	AT91C_SFR_EBIDELAY_DQS1_1                    (0x1 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_2                    (0x2 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_3                    (0x3 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_4                    (0x4 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_5                    (0x5 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_6                    (0x6 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_7                    (0x7 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_8                    (0x8 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_9                    (0x9 << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_10                   (0xA << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_11                   (0xB << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_12                   (0xC << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_13                   (0xD << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_14                   (0xE << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_15                   (0xF << 16) // (SFR) 
+#define 	AT91C_SFR_EBIDELAY_DQS1_16                   (0x10 << 16) // (SFR) 
+// -------- SFR_UTMICFG : (SFR Offset: 0x10) UTMI Software Reset -------- 
+#define AT91C_SFR_UTMICFG_PORT0 (0x1 <<  0) // (SFR) UTMI Software Reset port 0
+#define AT91C_SFR_UTMICFG_PORT1 (0x1 <<  1) // (SFR) UTMI Software Reset port 1
+#define AT91C_SFR_UTMICFG_OHCI_SUSP_INT_ENABLE (0x1 <<  2) // (SFR) OHCI Suspend Interrupt enable
+// -------- SFR_OHCI_SUSP_INT : (SFR Offset: 0x14) OHCI suspend Interrupt status -------- 
+#define AT91C_SFR_OHCI_SUSP_INT_STATUS (0x3 <<  0) // (SFR) OHCI suspend Interrupt status
+#define 	AT91C_SFR_OHCI_SUSP_INT_STATUS_PORT0                (0x1) // (SFR) OHCI suspend Interrupt status for port 0
+#define 	AT91C_SFR_OHCI_SUSP_INT_STATUS_PORT1                (0x2) // (SFR) OHCI suspend Interrupt status for port 1
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR System Peripherals
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_SYS {
+	AT91_REG	 Reserved0[3904]; 	// 
+	AT91_REG	 SYS_RSTC_RCR; 	// Reset Control Register
+	AT91_REG	 SYS_RSTC_RSR; 	// Reset Status Register
+	AT91_REG	 SYS_RSTC_RMR; 	// Reset Mode Register
+	AT91_REG	 Reserved1[1]; 	// 
+	AT91_REG	 SYS_SHDWC_SHCR; 	// Shut Down Control Register
+	AT91_REG	 SYS_SHDWC_SHMR; 	// Shut Down Mode Register
+	AT91_REG	 SYS_SHDWC_SHSR; 	// Shut Down Status Register
+	AT91_REG	 Reserved2[1]; 	// 
+	AT91_REG	 SYS_RTTC0_RTMR; 	// Real-time Mode Register
+	AT91_REG	 SYS_RTTC0_RTAR; 	// Real-time Alarm Register
+	AT91_REG	 SYS_RTTC0_RTVR; 	// Real-time Value Register
+	AT91_REG	 SYS_RTTC0_RTSR; 	// Real-time Status Register
+	AT91_REG	 SYS_PITC_PIMR; 	// Period Interval Mode Register
+	AT91_REG	 SYS_PITC_PISR; 	// Period Interval Status Register
+	AT91_REG	 SYS_PITC_PIVR; 	// Period Interval Value Register
+	AT91_REG	 SYS_PITC_PIIR; 	// Period Interval Image Register
+	AT91_REG	 SYS_WDTC_WDCR; 	// Watchdog Control Register
+	AT91_REG	 SYS_WDTC_WDMR; 	// Watchdog Mode Register
+	AT91_REG	 SYS_WDTC_WDSR; 	// Watchdog Status Register
+	AT91_REG	 Reserved3[1]; 	// 
+	AT91_REG	 SYS_SLCKSEL; 	// Slow Clock Selection Register
+	AT91_REG	 Reserved4[3]; 	// 
+	AT91_REG	 SYS_GPBR[4]; 	// General Purpose Register
+	AT91_REG	 Reserved5[16]; 	// 
+	AT91_REG	 RTC_CR; 	// Control Register
+	AT91_REG	 RTC_MR; 	// Mode Register
+	AT91_REG	 RTC_TIMR; 	// Time Register
+	AT91_REG	 RTC_CALR; 	// Calendar Register
+	AT91_REG	 RTC_TIMALR; 	// Time Alarm Register
+	AT91_REG	 RTC_CALALR; 	// Calendar Alarm Register
+	AT91_REG	 RTC_SR; 	// Status Register
+	AT91_REG	 RTC_SCCR; 	// Status Clear Command Register
+	AT91_REG	 RTC_IER; 	// Interrupt Enable Register
+	AT91_REG	 RTC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 RTC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 RTC_VER; 	// Valid Entry Register
+	AT91_REG	 Reserved6[7]; 	// 
+	AT91_REG	 SYS_RSTC_VER; 	// Version Register
+} AT91S_SYS, *AT91PS_SYS;
+#else
+#define SLCKSEL         (AT91_CAST(AT91_REG *) 	0x00003D50) // (SLCKSEL) Slow Clock Selection Register
+#define GPBR            (AT91_CAST(AT91_REG *) 	0x00003D60) // (GPBR) General Purpose Register
+
+#endif
+// -------- SLCKSEL : (SYS Offset: 0x3d50) Slow Clock Selection Register -------- 
+#define AT91C_SLCKSEL_RCEN    (0x1 <<  0) // (SYS) Enable Internal RC Oscillator
+#define AT91C_SLCKSEL_OSC32EN (0x1 <<  1) // (SYS) Enable External Oscillator
+#define AT91C_SLCKSEL_OSC32BYP (0x1 <<  2) // (SYS) Bypass External Oscillator
+#define AT91C_SLCKSEL_OSCSEL  (0x1 <<  3) // (SYS) OSC Selection
+// -------- GPBR : (SYS Offset: 0x3d60) GPBR General Purpose Register -------- 
+#define AT91C_GPBR_GPRV       (0x0 <<  0) // (SYS) General Purpose Register Value
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR External Bus Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_EBI {
+	AT91_REG	 EBI_DUMMY; 	// Dummy register - Do not use
+} AT91S_EBI, *AT91PS_EBI;
+#else
+#define EBI_DUMMY       (AT91_CAST(AT91_REG *) 	0x00000000) // (EBI_DUMMY) Dummy register - Do not use
+
+#endif
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR DDR2/SDRAM Controller
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_HDDRSDRC2 {
+	AT91_REG	 HDDRSDRC2_MR; 	// Mode Register
+	AT91_REG	 HDDRSDRC2_RTR; 	// Refresh Timer Register
+	AT91_REG	 HDDRSDRC2_CR; 	// Configuration Register
+	AT91_REG	 HDDRSDRC2_T0PR; 	// Timing0 Register
+	AT91_REG	 HDDRSDRC2_T1PR; 	// Timing1 Register
+	AT91_REG	 HDDRSDRC2_T2PR; 	// Timing2 Register
+	AT91_REG	 Reserved0[1]; 	// 
+	AT91_REG	 HDDRSDRC2_LPR; 	// Low-power Register
+	AT91_REG	 HDDRSDRC2_MDR; 	// Memory Device Register
+	AT91_REG	 HDDRSDRC2_DLL; 	// DLL Information Register
+	AT91_REG	 HDDRSDRC2_VER; 	// DLL Version Register
+	AT91_REG	 HDDRSDRC2_HS; 	// High Speed Register
+	AT91_REG	 HDDRSDRC2_DELAY1; 	// Pad delay1 Register
+	AT91_REG	 HDDRSDRC2_DELAY2; 	// Pad delay2 Register
+	AT91_REG	 HDDRSDRC2_DELAY3; 	// Pad delay3 Register
+	AT91_REG	 HDDRSDRC2_DELAY4; 	// Pad delay4 Register
+	AT91_REG	 HDDRSDRC2_DELAY5; 	// Pad delay5 Register
+	AT91_REG	 HDDRSDRC2_DELAY6; 	// Pad delay6 Register
+	AT91_REG	 HDDRSDRC2_DELAY7; 	// Pad delay7 Register
+	AT91_REG	 HDDRSDRC2_DELAY8; 	// Pad delay8 Register
+	AT91_REG	 Reserved1[37]; 	// 
+	AT91_REG	 HDDRSDRC2_WPMR; 	// Write Protect Mode Register
+	AT91_REG	 HDDRSDRC2_WPSR; 	// Write Protect Status Register
+	AT91_REG	 Reserved2[4]; 	// 
+	AT91_REG	 HDDRSDRC2_VERSION; 	// Version Register
+} AT91S_HDDRSDRC2, *AT91PS_HDDRSDRC2;
+#else
+#define HDDRSDRC2_MR    (AT91_CAST(AT91_REG *) 	0x00000000) // (HDDRSDRC2_MR) Mode Register
+#define HDDRSDRC2_RTR   (AT91_CAST(AT91_REG *) 	0x00000004) // (HDDRSDRC2_RTR) Refresh Timer Register
+#define HDDRSDRC2_CR    (AT91_CAST(AT91_REG *) 	0x00000008) // (HDDRSDRC2_CR) Configuration Register
+#define HDDRSDRC2_T0PR  (AT91_CAST(AT91_REG *) 	0x0000000C) // (HDDRSDRC2_T0PR) Timing0 Register
+#define HDDRSDRC2_T1PR  (AT91_CAST(AT91_REG *) 	0x00000010) // (HDDRSDRC2_T1PR) Timing1 Register
+#define HDDRSDRC2_T2PR  (AT91_CAST(AT91_REG *) 	0x00000014) // (HDDRSDRC2_T2PR) Timing2 Register
+#define HDDRSDRC2_LPR   (AT91_CAST(AT91_REG *) 	0x0000001C) // (HDDRSDRC2_LPR) Low-power Register
+#define HDDRSDRC2_MDR   (AT91_CAST(AT91_REG *) 	0x00000020) // (HDDRSDRC2_MDR) Memory Device Register
+#define HDDRSDRC2_DLL   (AT91_CAST(AT91_REG *) 	0x00000024) // (HDDRSDRC2_DLL) DLL Information Register
+#define HDDRSDRC2_DLL_VER (AT91_CAST(AT91_REG *) 	0x00000028) // (HDDRSDRC2_DLL_VER) DLL Version Register
+#define HDDRSDRC2_HS    (AT91_CAST(AT91_REG *) 	0x0000002C) // (HDDRSDRC2_HS) High Speed Register
+#define HDDRSDRC2_DELAY1 (AT91_CAST(AT91_REG *) 	0x00000030) // (HDDRSDRC2_DELAY1) Pad delay1 Register
+#define HDDRSDRC2_DELAY2 (AT91_CAST(AT91_REG *) 	0x00000034) // (HDDRSDRC2_DELAY2) Pad delay2 Register
+#define HDDRSDRC2_DELAY3 (AT91_CAST(AT91_REG *) 	0x00000038) // (HDDRSDRC2_DELAY3) Pad delay3 Register
+#define HDDRSDRC2_DELAY4 (AT91_CAST(AT91_REG *) 	0x0000003C) // (HDDRSDRC2_DELAY4) Pad delay4 Register
+#define HDDRSDRC2_DELAY5 (AT91_CAST(AT91_REG *) 	0x00000040) // (HDDRSDRC2_DELAY5) Pad delay5 Register
+#define HDDRSDRC2_DELAY6 (AT91_CAST(AT91_REG *) 	0x00000044) // (HDDRSDRC2_DELAY6) Pad delay6 Register
+#define HDDRSDRC2_DELAY7 (AT91_CAST(AT91_REG *) 	0x00000048) // (HDDRSDRC2_DELAY7) Pad delay7 Register
+#define HDDRSDRC2_DELAY8 (AT91_CAST(AT91_REG *) 	0x0000004C) // (HDDRSDRC2_DELAY8) Pad delay8 Register
+#define HDDRSDRC2_WPMR  (AT91_CAST(AT91_REG *) 	0x000000E4) // (HDDRSDRC2_WPMR) Write Protect Mode Register
+#define HDDRSDRC2_WPSR  (AT91_CAST(AT91_REG *) 	0x000000E8) // (HDDRSDRC2_WPSR) Write Protect Status Register
+#define HDDRSDRC2_VERSION (AT91_CAST(AT91_REG *) 	0x000000FC) // (HDDRSDRC2_VERSION) Version Register
+
+#endif
+// -------- HDDRSDRC2_MR : (HDDRSDRC2 Offset: 0x0) Mode Register -------- 
+#define AT91C_DDRC2_MODE      (0x7 <<  0) // (HDDRSDRC2) DDR/SDRAM Command Mode
+#define 	AT91C_DDRC2_MODE_NORMAL_CMD           (0x0) // (HDDRSDRC2) Normal Mode
+#define 	AT91C_DDRC2_MODE_NOP_CMD              (0x1) // (HDDRSDRC2) Issue a NOP Command at every access
+#define 	AT91C_DDRC2_MODE_PRCGALL_CMD          (0x2) // (HDDRSDRC2) Issue a All Banks Precharge Command at every access
+#define 	AT91C_DDRC2_MODE_LMR_CMD              (0x3) // (HDDRSDRC2) Issue a Load Mode Register at every access
+#define 	AT91C_DDRC2_MODE_RFSH_CMD             (0x4) // (HDDRSDRC2) Issue a Refresh
+#define 	AT91C_DDRC2_MODE_EXT_LMR_CMD          (0x5) // (HDDRSDRC2) Issue an Extended Load Mode Register
+#define 	AT91C_DDRC2_MODE_DEEP_CMD             (0x6) // (HDDRSDRC2) Enter Deep Power Mode
+#define 	AT91C_DDRC2_MODE_Reserved             (0x7) // (HDDRSDRC2) Reserved value
+// -------- HDDRSDRC2_RTR : (HDDRSDRC2 Offset: 0x4) Refresh Timer Register -------- 
+#define AT91C_DDRC2_COUNT     (0xFFF <<  0) // (HDDRSDRC2) Refresh Timer Count
+// -------- HDDRSDRC2_CR : (HDDRSDRC2 Offset: 0x8) Configuration Register -------- 
+#define AT91C_DDRC2_NC        (0x3 <<  0) // (HDDRSDRC2) Number of Column Bits
+#define 	AT91C_DDRC2_NC_DDR9_SDR8            (0x0) // (HDDRSDRC2) DDR 9 Bits | SDR 8 Bits
+#define 	AT91C_DDRC2_NC_DDR10_SDR9           (0x1) // (HDDRSDRC2) DDR 10 Bits | SDR 9 Bits
+#define 	AT91C_DDRC2_NC_DDR11_SDR10          (0x2) // (HDDRSDRC2) DDR 11 Bits | SDR 10 Bits
+#define 	AT91C_DDRC2_NC_DDR12_SDR11          (0x3) // (HDDRSDRC2) DDR 12 Bits | SDR 11 Bits
+#define AT91C_DDRC2_NR        (0x3 <<  2) // (HDDRSDRC2) Number of Row Bits
+#define 	AT91C_DDRC2_NR_11                   (0x0 <<  2) // (HDDRSDRC2) 11 Bits
+#define 	AT91C_DDRC2_NR_12                   (0x1 <<  2) // (HDDRSDRC2) 12 Bits
+#define 	AT91C_DDRC2_NR_13                   (0x2 <<  2) // (HDDRSDRC2) 13 Bits
+#define 	AT91C_DDRC2_NR_14                   (0x3 <<  2) // (HDDRSDRC2) 14 Bits
+#define AT91C_DDRC2_CAS       (0x7 <<  4) // (HDDRSDRC2) CAS Latency
+#define 	AT91C_DDRC2_CAS_2                    (0x2 <<  4) // (HDDRSDRC2) 2 cycles (SDR CAS Latency)
+#define 	AT91C_DDRC2_CAS_3                    (0x3 <<  4) // (HDDRSDRC2) 3 cycles (DDR2 CAS Latency), 3 cycles (SDR CAS Latency)
+#define AT91C_DDRC2_DLL       (0x1 <<  7) // (HDDRSDRC2) DLL Reset
+#define 	AT91C_DDRC2_DLL_RESET_DISABLED       (0x0 <<  7) // (HDDRSDRC2) DLL normal mode
+#define 	AT91C_DDRC2_DLL_RESET_ENABLED        (0x1 <<  7) // (HDDRSDRC2) Reset DLL
+#define AT91C_DDRC2_DIC_DS    (0x1 <<  8) // (HDDRSDRC2) Output driver impedance control
+#define 	AT91C_DDRC2_DIC_DS_NORMAL               (0x0 <<  8) // (HDDRSDRC2) Normal driver strength.
+#define 	AT91C_DDRC2_DIC_DS_WEEK                 (0x1 <<  8) // (HDDRSDRC2) Weak driver strength
+#define AT91C_DDRC2_DIS_DLL   (0x1 <<  9) // (HDDRSDRC2) Disable DLL
+#define 	AT91C_DDRC2_DIS_DLL_ENABLE               (0x0 <<  9) // (HDDRSDRC2) Enable DLL
+#define 	AT91C_DDRC2_DIS_DLL_DISABLE              (0x1 <<  9) // (HDDRSDRC2) Disable DLL
+#define AT91C_DDRC2_OCD       (0x7 << 12) // (HDDRSDRC2) Off chip driver
+#define 	AT91C_DDRC2_OCD_EXIT                 (0x0 << 12) // (HDDRSDRC2) Exit OCD calibration mode.
+#define 	AT91C_DDRC2_OCD_DEFAULT              (0x7 << 12) // (HDDRSDRC2) Program OCD calibration default value.
+#define AT91C_DDRC2_DQMS      (0x1 << 16) // (HDDRSDRC2) Data Mask share
+#define 	AT91C_DDRC2_DQMS_NOT_SHARED           (0x0 << 16) // (HDDRSDRC2) Used DQM bits are not shared
+#define 	AT91C_DDRC2_DQMS_SHARED               (0x1 << 16) // (HDDRSDRC2) Used DQM bits are shared
+#define AT91C_DDRC2_ACTBST    (0x1 << 18) // (HDDRSDRC2) ACTIVE Bank X to Burst Stop Read Access Bank Y
+#define 	AT91C_DDRC2_ACTBST_CAN_ACCESS           (0x0 << 18) // (HDDRSDRC2) After an ACTIVE command in Bank X, BURST STOP command can be issued to another bank to stop current read access.
+#define 	AT91C_DDRC2_ACTBST_NOT_ACCESS           (0x1 << 18) // (HDDRSDRC2) After an ACTIVE command in Bank X, BURST STOP command cannot be issued to another bank to stop current read access.
+// -------- HDDRSDRC2_T0PR : (HDDRSDRC2 Offset: 0xc) Timing0 Register -------- 
+#define AT91C_DDRC2_TRAS      (0xF <<  0) // (HDDRSDRC2) Active to precharge delay
+#define 	AT91C_DDRC2_TRAS_0                    (0x0) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRAS_1                    (0x1) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRAS_2                    (0x2) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRAS_3                    (0x3) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRAS_4                    (0x4) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRAS_5                    (0x5) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRAS_6                    (0x6) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRAS_7                    (0x7) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TRAS_8                    (0x8) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TRAS_9                    (0x9) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TRAS_10                   (0xA) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TRAS_11                   (0xB) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TRAS_12                   (0xC) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TRAS_13                   (0xD) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TRAS_14                   (0xE) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TRAS_15                   (0xF) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TRCD      (0xF <<  4) // (HDDRSDRC2) Row to column delay
+#define 	AT91C_DDRC2_TRCD_0                    (0x0 <<  4) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRCD_1                    (0x1 <<  4) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRCD_2                    (0x2 <<  4) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRCD_3                    (0x3 <<  4) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRCD_4                    (0x4 <<  4) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRCD_5                    (0x5 <<  4) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRCD_6                    (0x6 <<  4) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRCD_7                    (0x7 <<  4) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TRCD_8                    (0x8 <<  4) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TRCD_9                    (0x9 <<  4) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TRCD_10                   (0xA <<  4) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TRCD_11                   (0xB <<  4) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TRCD_12                   (0xC <<  4) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TRCD_13                   (0xD <<  4) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TRCD_14                   (0xE <<  4) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TRCD_15                   (0xF <<  4) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TWR       (0xF <<  8) // (HDDRSDRC2) Write recovery delay
+#define 	AT91C_DDRC2_TWR_0                    (0x0 <<  8) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TWR_1                    (0x1 <<  8) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TWR_2                    (0x2 <<  8) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TWR_3                    (0x3 <<  8) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TWR_4                    (0x4 <<  8) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TWR_5                    (0x5 <<  8) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TWR_6                    (0x6 <<  8) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TWR_7                    (0x7 <<  8) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TWR_8                    (0x8 <<  8) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TWR_9                    (0x9 <<  8) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TWR_10                   (0xA <<  8) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TWR_11                   (0xB <<  8) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TWR_12                   (0xC <<  8) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TWR_13                   (0xD <<  8) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TWR_14                   (0xE <<  8) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TWR_15                   (0xF <<  8) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TRC       (0xF << 12) // (HDDRSDRC2) Row cycle delay
+#define 	AT91C_DDRC2_TRC_0                    (0x0 << 12) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRC_1                    (0x1 << 12) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRC_2                    (0x2 << 12) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRC_3                    (0x3 << 12) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRC_4                    (0x4 << 12) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRC_5                    (0x5 << 12) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRC_6                    (0x6 << 12) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRC_7                    (0x7 << 12) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TRC_8                    (0x8 << 12) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TRC_9                    (0x9 << 12) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TRC_10                   (0xA << 12) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TRC_11                   (0xB << 12) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TRC_12                   (0xC << 12) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TRC_13                   (0xD << 12) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TRC_14                   (0xE << 12) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TRC_15                   (0xF << 12) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TRP       (0xF << 16) // (HDDRSDRC2) Row precharge delay
+#define 	AT91C_DDRC2_TRP_0                    (0x0 << 16) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRP_1                    (0x1 << 16) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRP_2                    (0x2 << 16) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRP_3                    (0x3 << 16) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRP_4                    (0x4 << 16) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRP_5                    (0x5 << 16) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRP_6                    (0x6 << 16) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRP_7                    (0x7 << 16) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TRP_8                    (0x8 << 16) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TRP_9                    (0x9 << 16) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TRP_10                   (0xA << 16) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TRP_11                   (0xB << 16) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TRP_12                   (0xC << 16) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TRP_13                   (0xD << 16) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TRP_14                   (0xE << 16) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TRP_15                   (0xF << 16) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TRRD      (0xF << 20) // (HDDRSDRC2) Active bankA to Active bankB
+#define 	AT91C_DDRC2_TRRD_0                    (0x0 << 20) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRRD_1                    (0x1 << 20) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRRD_2                    (0x2 << 20) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRRD_3                    (0x3 << 20) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRRD_4                    (0x4 << 20) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRRD_5                    (0x5 << 20) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRRD_6                    (0x6 << 20) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRRD_7                    (0x7 << 20) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TRRD_8                    (0x8 << 20) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TRRD_9                    (0x9 << 20) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TRRD_10                   (0xA << 20) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TRRD_11                   (0xB << 20) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TRRD_12                   (0xC << 20) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TRRD_13                   (0xD << 20) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TRRD_14                   (0xE << 20) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TRRD_15                   (0xF << 20) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TWTR      (0x7 << 24) // (HDDRSDRC2) Internal write to read delay
+#define 	AT91C_DDRC2_TWTR_0                    (0x0 << 24) // (HDDRSDRC2) Value : 1
+#define 	AT91C_DDRC2_TWTR_1                    (0x1 << 24) // (HDDRSDRC2) Value : 2
+#define AT91C_REDUCE_WRRD     (0x1 << 27) // (HDDRSDRC2) Reduce Write to Read Delay
+#define AT91C_DDRC2_TMRD      (0xF << 28) // (HDDRSDRC2) Load mode register command to active or refresh command
+#define 	AT91C_DDRC2_TMRD_0                    (0x0 << 28) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TMRD_1                    (0x1 << 28) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TMRD_2                    (0x2 << 28) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TMRD_3                    (0x3 << 28) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TMRD_4                    (0x4 << 28) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TMRD_5                    (0x5 << 28) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TMRD_6                    (0x6 << 28) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TMRD_7                    (0x7 << 28) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TMRD_8                    (0x8 << 28) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TMRD_9                    (0x9 << 28) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TMRD_10                   (0xA << 28) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TMRD_11                   (0xB << 28) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TMRD_12                   (0xC << 28) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TMRD_13                   (0xD << 28) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TMRD_14                   (0xE << 28) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TMRD_15                   (0xF << 28) // (HDDRSDRC2) Value : 15
+// -------- HDDRSDRC2_T1PR : (HDDRSDRC2 Offset: 0x10) Timing1 Register -------- 
+#define AT91C_DDRC2_TRFC      (0x1F <<  0) // (HDDRSDRC2) row cycle delay
+#define 	AT91C_DDRC2_TRFC_0                    (0x0) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRFC_1                    (0x1) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRFC_2                    (0x2) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRFC_3                    (0x3) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRFC_4                    (0x4) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRFC_5                    (0x5) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRFC_6                    (0x6) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRFC_7                    (0x7) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TRFC_8                    (0x8) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TRFC_9                    (0x9) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TRFC_10                   (0xA) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TRFC_11                   (0xB) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TRFC_12                   (0xC) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TRFC_13                   (0xD) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TRFC_14                   (0xE) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TRFC_15                   (0xF) // (HDDRSDRC2) Value : 15
+#define 	AT91C_DDRC2_TRFC_16                   (0x10) // (HDDRSDRC2) Value : 16
+#define 	AT91C_DDRC2_TRFC_17                   (0x11) // (HDDRSDRC2) Value : 17
+#define 	AT91C_DDRC2_TRFC_18                   (0x12) // (HDDRSDRC2) Value : 18
+#define 	AT91C_DDRC2_TRFC_19                   (0x13) // (HDDRSDRC2) Value : 19
+#define 	AT91C_DDRC2_TRFC_20                   (0x14) // (HDDRSDRC2) Value : 20
+#define 	AT91C_DDRC2_TRFC_21                   (0x15) // (HDDRSDRC2) Value : 21
+#define 	AT91C_DDRC2_TRFC_22                   (0x16) // (HDDRSDRC2) Value : 22
+#define 	AT91C_DDRC2_TRFC_23                   (0x17) // (HDDRSDRC2) Value : 23
+#define 	AT91C_DDRC2_TRFC_24                   (0x18) // (HDDRSDRC2) Value : 24
+#define 	AT91C_DDRC2_TRFC_25                   (0x19) // (HDDRSDRC2) Value : 25
+#define 	AT91C_DDRC2_TRFC_26                   (0x1A) // (HDDRSDRC2) Value : 26
+#define 	AT91C_DDRC2_TRFC_27                   (0x1B) // (HDDRSDRC2) Value : 27
+#define 	AT91C_DDRC2_TRFC_28                   (0x1C) // (HDDRSDRC2) Value : 28
+#define 	AT91C_DDRC2_TRFC_29                   (0x1D) // (HDDRSDRC2) Value : 29
+#define 	AT91C_DDRC2_TRFC_30                   (0x1E) // (HDDRSDRC2) Value : 30
+#define 	AT91C_DDRC2_TRFC_31                   (0x1F) // (HDDRSDRC2) Value : 31
+#define AT91C_DDRC2_TXSNR     (0xFF <<  8) // (HDDRSDRC2) Exit self refresh delay to Read command
+#define 	AT91C_DDRC2_TXSNR_0                    (0x0 <<  8) // (HDDRSDRC2) Value :   0
+#define 	AT91C_DDRC2_TXSNR_8                    (0x8 <<  8) // (HDDRSDRC2) Value :   8
+#define 	AT91C_DDRC2_TXSNR_16                   (0x10 <<  8) // (HDDRSDRC2) Value :  16
+#define 	AT91C_DDRC2_TXSNR_32                   (0x20 <<  8) // (HDDRSDRC2) Value :  32
+#define 	AT91C_DDRC2_TXSNR_48                   (0x30 <<  8) // (HDDRSDRC2) Value :  48
+#define 	AT91C_DDRC2_TXSNR_64                   (0x40 <<  8) // (HDDRSDRC2) Value :  64
+#define 	AT91C_DDRC2_TXSNR_80                   (0x50 <<  8) // (HDDRSDRC2) Value :  80
+#define 	AT91C_DDRC2_TXSNR_96                   (0x60 <<  8) // (HDDRSDRC2) Value :  96
+#define 	AT91C_DDRC2_TXSNR_112                  (0x70 <<  8) // (HDDRSDRC2) Value : 112
+#define 	AT91C_DDRC2_TXSNR_128                  (0x80 <<  8) // (HDDRSDRC2) Value : 128
+#define 	AT91C_DDRC2_TXSNR_144                  (0x90 <<  8) // (HDDRSDRC2) Value : 144
+#define 	AT91C_DDRC2_TXSNR_160                  (0xA0 <<  8) // (HDDRSDRC2) Value : 160
+#define 	AT91C_DDRC2_TXSNR_176                  (0xB0 <<  8) // (HDDRSDRC2) Value : 176
+#define 	AT91C_DDRC2_TXSNR_192                  (0xC0 <<  8) // (HDDRSDRC2) Value : 192
+#define 	AT91C_DDRC2_TXSNR_208                  (0xD0 <<  8) // (HDDRSDRC2) Value : 208
+#define 	AT91C_DDRC2_TXSNR_224                  (0xE0 <<  8) // (HDDRSDRC2) Value : 224
+#define 	AT91C_DDRC2_TXSNR_240                  (0xF0 <<  8) // (HDDRSDRC2) Value : 240
+#define 	AT91C_DDRC2_TXSNR_255                  (0xFF <<  8) // (HDDRSDRC2) Value : 255
+#define AT91C_DDRC2_TXSRD     (0xFF << 16) // (HDDRSDRC2) Exit self refresh delay to Read command
+#define 	AT91C_DDRC2_TXSRD_0                    (0x0 << 16) // (HDDRSDRC2) Value :   0
+#define 	AT91C_DDRC2_TXSRD_8                    (0x8 << 16) // (HDDRSDRC2) Value :   8
+#define 	AT91C_DDRC2_TXSRD_16                   (0x10 << 16) // (HDDRSDRC2) Value :  16
+#define 	AT91C_DDRC2_TXSRD_32                   (0x20 << 16) // (HDDRSDRC2) Value :  32
+#define 	AT91C_DDRC2_TXSRD_48                   (0x30 << 16) // (HDDRSDRC2) Value :  48
+#define 	AT91C_DDRC2_TXSRD_64                   (0x40 << 16) // (HDDRSDRC2) Value :  64
+#define 	AT91C_DDRC2_TXSRD_80                   (0x50 << 16) // (HDDRSDRC2) Value :  80
+#define 	AT91C_DDRC2_TXSRD_96                   (0x60 << 16) // (HDDRSDRC2) Value :  96
+#define 	AT91C_DDRC2_TXSRD_112                  (0x70 << 16) // (HDDRSDRC2) Value : 112
+#define 	AT91C_DDRC2_TXSRD_128                  (0x80 << 16) // (HDDRSDRC2) Value : 128
+#define 	AT91C_DDRC2_TXSRD_144                  (0x90 << 16) // (HDDRSDRC2) Value : 144
+#define 	AT91C_DDRC2_TXSRD_160                  (0xA0 << 16) // (HDDRSDRC2) Value : 160
+#define 	AT91C_DDRC2_TXSRD_176                  (0xB0 << 16) // (HDDRSDRC2) Value : 176
+#define 	AT91C_DDRC2_TXSRD_192                  (0xC0 << 16) // (HDDRSDRC2) Value : 192
+#define 	AT91C_DDRC2_TXSRD_208                  (0xD0 << 16) // (HDDRSDRC2) Value : 208
+#define 	AT91C_DDRC2_TXSRD_224                  (0xE0 << 16) // (HDDRSDRC2) Value : 224
+#define 	AT91C_DDRC2_TXSRD_240                  (0xF0 << 16) // (HDDRSDRC2) Value : 240
+#define 	AT91C_DDRC2_TXSRD_255                  (0xFF << 16) // (HDDRSDRC2) Value : 255
+#define AT91C_DDRC2_TXP       (0xF << 24) // (HDDRSDRC2) Exit Power-down delay to first command
+#define 	AT91C_DDRC2_TXP_0                    (0x0 << 24) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TXP_1                    (0x1 << 24) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TXP_2                    (0x2 << 24) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TXP_3                    (0x3 << 24) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TXP_4                    (0x4 << 24) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TXP_5                    (0x5 << 24) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TXP_6                    (0x6 << 24) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TXP_7                    (0x7 << 24) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TXP_8                    (0x8 << 24) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TXP_9                    (0x9 << 24) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TXP_10                   (0xA << 24) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TXP_11                   (0xB << 24) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TXP_12                   (0xC << 24) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TXP_13                   (0xD << 24) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TXP_14                   (0xE << 24) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TXP_15                   (0xF << 24) // (HDDRSDRC2) Value : 15
+// -------- HDDRSDRC2_T2PR : (HDDRSDRC2 Offset: 0x14) Timing2 Register -------- 
+#define AT91C_DDRC2_TXARD     (0xF <<  0) // (HDDRSDRC2) Exit active power down delay to read command in 'Fast Exit' mode.
+#define 	AT91C_DDRC2_TXARD_0                    (0x0) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TXARD_1                    (0x1) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TXARD_2                    (0x2) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TXARD_3                    (0x3) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TXARD_4                    (0x4) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TXARD_5                    (0x5) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TXARD_6                    (0x6) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TXARD_7                    (0x7) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TXARD_8                    (0x8) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TXARD_9                    (0x9) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TXARD_10                   (0xA) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TXARD_11                   (0xB) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TXARD_12                   (0xC) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TXARD_13                   (0xD) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TXARD_14                   (0xE) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TXARD_15                   (0xF) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TXARDS    (0xF <<  4) // (HDDRSDRC2) Exit active power down delay to read command in 'Slow Exit' mode.
+#define 	AT91C_DDRC2_TXARDS_0                    (0x0 <<  4) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TXARDS_1                    (0x1 <<  4) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TXARDS_2                    (0x2 <<  4) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TXARDS_3                    (0x3 <<  4) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TXARDS_4                    (0x4 <<  4) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TXARDS_5                    (0x5 <<  4) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TXARDS_6                    (0x6 <<  4) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TXARDS_7                    (0x7 <<  4) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TXARDS_8                    (0x8 <<  4) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TXARDS_9                    (0x9 <<  4) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TXARDS_10                   (0xA <<  4) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TXARDS_11                   (0xB <<  4) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TXARDS_12                   (0xC <<  4) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TXARDS_13                   (0xD <<  4) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TXARDS_14                   (0xE <<  4) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TXARDS_15                   (0xF <<  4) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TRPA      (0xF <<  8) // (HDDRSDRC2) Row precharge all delay
+#define 	AT91C_DDRC2_TRPA_0                    (0x0 <<  8) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRPA_1                    (0x1 <<  8) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRPA_2                    (0x2 <<  8) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRPA_3                    (0x3 <<  8) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRPA_4                    (0x4 <<  8) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRPA_5                    (0x5 <<  8) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRPA_6                    (0x6 <<  8) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRPA_7                    (0x7 <<  8) // (HDDRSDRC2) Value :  7
+#define 	AT91C_DDRC2_TRPA_8                    (0x8 <<  8) // (HDDRSDRC2) Value :  8
+#define 	AT91C_DDRC2_TRPA_9                    (0x9 <<  8) // (HDDRSDRC2) Value :  9
+#define 	AT91C_DDRC2_TRPA_10                   (0xA <<  8) // (HDDRSDRC2) Value : 10
+#define 	AT91C_DDRC2_TRPA_11                   (0xB <<  8) // (HDDRSDRC2) Value : 11
+#define 	AT91C_DDRC2_TRPA_12                   (0xC <<  8) // (HDDRSDRC2) Value : 12
+#define 	AT91C_DDRC2_TRPA_13                   (0xD <<  8) // (HDDRSDRC2) Value : 13
+#define 	AT91C_DDRC2_TRPA_14                   (0xE <<  8) // (HDDRSDRC2) Value : 14
+#define 	AT91C_DDRC2_TRPA_15                   (0xF <<  8) // (HDDRSDRC2) Value : 15
+#define AT91C_DDRC2_TRTP      (0x7 << 12) // (HDDRSDRC2) Read to Precharge delay
+#define 	AT91C_DDRC2_TRTP_0                    (0x0 << 12) // (HDDRSDRC2) Value :  0
+#define 	AT91C_DDRC2_TRTP_1                    (0x1 << 12) // (HDDRSDRC2) Value :  1
+#define 	AT91C_DDRC2_TRTP_2                    (0x2 << 12) // (HDDRSDRC2) Value :  2
+#define 	AT91C_DDRC2_TRTP_3                    (0x3 << 12) // (HDDRSDRC2) Value :  3
+#define 	AT91C_DDRC2_TRTP_4                    (0x4 << 12) // (HDDRSDRC2) Value :  4
+#define 	AT91C_DDRC2_TRTP_5                    (0x5 << 12) // (HDDRSDRC2) Value :  5
+#define 	AT91C_DDRC2_TRTP_6                    (0x6 << 12) // (HDDRSDRC2) Value :  6
+#define 	AT91C_DDRC2_TRTP_7                    (0x7 << 12) // (HDDRSDRC2) Value :  7
+// -------- HDDRSDRC2_LPR : (HDDRSDRC2 Offset: 0x1c)  -------- 
+#define AT91C_DDRC2_LPCB      (0x3 <<  0) // (HDDRSDRC2) Low-power Command Bit
+#define 	AT91C_DDRC2_LPCB_DISABLED             (0x0) // (HDDRSDRC2) Low-power Feature is inhibited: no power-down, self refresh and Deep power mode are issued to the SDRAM device.
+#define 	AT91C_DDRC2_LPCB_SELFREFRESH          (0x1) // (HDDRSDRC2) The DDRSDRAMC Controller issues a Self Refresh Command to the SDRAM device, the clock(s) is/are de-activated and the CKE signal is set low. The SDRAM device leaves the self refresh mode when accessed and enters it after the access.
+#define 	AT91C_DDRC2_LPCB_POWERDOWN            (0x2) // (HDDRSDRC2) The HDDRSDRC2 Controller issues a Power-down Command to the SDRAM device after each access, the CKE signal is set low. The SDRAM device leaves the power-down mode when accessed and enters it after the access.
+#define 	AT91C_DDRC2_LPCB_DEEP_PWD             (0x3) // (HDDRSDRC2) The HDDRSDRC2 Controller issues a Deep Power-down Command to the Mobile SDRAM device. This mode is unique to Mobile SDRAM devices
+#define AT91C_DDRC2_CLK_FR    (0x1 <<  2) // (HDDRSDRC2) Clock frozen Command Bit
+#define 	AT91C_DDRC2_CLK_FR_DISABLED             (0x0 <<  2) // (HDDRSDRC2) Low-power Feature is inhibited: no power-down, self refresh and Deep power mode are issued to the SDRAM device.
+#define 	AT91C_DDRC2_CLK_FR_SELFREFRESH          (0x1 <<  2) // (HDDRSDRC2) The DDRSDRAMC Controller issues a Self Refresh Command to the SDRAM device, the clock(s) is/are de-activated and the CKE signal is set low. The SDRAM device leaves the self refresh mode when accessed and enters it after the access.
+#define 	AT91C_DDRC2_CLK_FR_POWERDOWN            (0x2 <<  2) // (HDDRSDRC2) The HDDRSDRC2 Controller issues a Power-down Command to the SDRAM device after each access, the CKE signal is set low. The SDRAM device leaves the power-down mode when accessed and enters it after the access.
+#define 	AT91C_DDRC2_CLK_FR_DEEP_PWD             (0x3 <<  2) // (HDDRSDRC2) The HDDRSDRC2 Controller issues a Deep Power-down Command to the Mobile SDRAM device. This mode is unique to Mobile SDRAM devices
+#define AT91C_DDRC2_PASR      (0x7 <<  4) // (HDDRSDRC2) Partial Array Self Refresh
+#define AT91C_DDRC2_TCR       (0x3 <<  8) // (HDDRSDRC2) Temperature compensated self refresh
+#define AT91C_DDRC2_DS        (0x3 << 10) // (HDDRSDRC2) Drive strength
+#define AT91C_DDRC2_TIMEOUT   (0x3 << 12) // (HDDRSDRC2) low-power mode delay
+#define 	AT91C_DDRC2_TIMEOUT_0                    (0x0 << 12) // (HDDRSDRC2) The SDRAM controller activates the SDRAM low-power mode immediately after the end of the last transfer.
+#define 	AT91C_DDRC2_TIMEOUT_64                   (0x1 << 12) // (HDDRSDRC2) The SDRAM controller activates the SDRAM low-power mode 64 clock cycles after the end of the last transfer.
+#define 	AT91C_DDRC2_TIMEOUT_128                  (0x2 << 12) // (HDDRSDRC2) The SDRAM controller activates the SDRAM low-power mode 128 clock cycles after the end of the last transfer.
+#define 	AT91C_DDRC2_TIMEOUT_Reserved             (0x3 << 12) // (HDDRSDRC2) Reserved
+#define AT91C_DDRC2_ADPE      (0x1 << 16) // (HDDRSDRC2) Active Power Down Exit time
+#define 	AT91C_DDRC2_ADPE_FAST                 (0x0 << 16) // (HDDRSDRC2) Fast Exit
+#define 	AT91C_DDRC2_ADPE_SLOW                 (0x1 << 16) // (HDDRSDRC2) Slow Exit
+// -------- HDDRSDRC2_MDR : (HDDRSDRC2 Offset: 0x20) Memory Device Register -------- 
+#define AT91C_DDRC2_MD        (0x7 <<  0) // (HDDRSDRC2) memory device
+#define 	AT91C_DDRC2_MD_SDR_SDRAM            (0x0) // (HDDRSDRC2) SDR SDRAM
+#define 	AT91C_DDRC2_MD_LP_SDR_SDRAM         (0x1) // (HDDRSDRC2) Low Power SDR SDRAM
+#define 	AT91C_DDRC2_MD_DDR_SDRAM            (0x2) // (HDDRSDRC2) DDR SDRAM
+#define 	AT91C_DDRC2_MD_LP_DDR_SDRAM         (0x3) // (HDDRSDRC2) Low Power DDR SDRAM
+#define 	AT91C_DDRC2_MD_DDR2_SDRAM           (0x6) // (HDDRSDRC2) DDR2 SDRAM
+#define AT91C_DDRC2_DBW       (0x1 <<  4) // (HDDRSDRC2) Data Bus Width
+#define 	AT91C_DDRC2_DBW_32_BITS              (0x0 <<  4) // (HDDRSDRC2) 32 Bits datas bus
+#define 	AT91C_DDRC2_DBW_16_BITS              (0x1 <<  4) // (HDDRSDRC2) 16 Bits datas bus
+// -------- HDDRSDRC2_DLL : (HDDRSDRC2 Offset: 0x24) DLL Information Register -------- 
+#define AT91C_DDRC2_MDINC     (0x1 <<  0) // (HDDRSDRC2) DLL Master Delay Increment
+#define AT91C_DDRC2_MDDEC     (0x1 <<  1) // (HDDRSDRC2) DLL Master Delay Decrement
+#define AT91C_DDRC2_MDOVF     (0x1 <<  2) // (HDDRSDRC2) DLL Master Delay Overflow Flag
+#define AT91C_DDRC2_MDVAL     (0xFF <<  8) // (HDDRSDRC2) DLL Master Delay Value
+// -------- HDDRSDRC2_HS : (HDDRSDRC2 Offset: 0x2c) High Speed Register -------- 
+#define AT91C_DDRC2_NO_OPT    (0x1 <<  1) // (HDDRSDRC2) Disable optimization
+#define AT91C_DDRC2_NO_ANT    (0x1 <<  2) // (HDDRSDRC2) Disable Anticipated read
+// -------- HDDRSDRC2_DELAY1 : (HDDRSDRC2 Offset: 0x30) Pad delay1 Register -------- 
+#define AT91C_DDRC2_DELAY     (0xF <<  0) // (HDDRSDRC2) Pad delay value
+// -------- HDDRSDRC2_DELAY2 : (HDDRSDRC2 Offset: 0x34) Pad delay2 Register -------- 
+// -------- HDDRSDRC2_DELAY3 : (HDDRSDRC2 Offset: 0x38) Pad delay3 Register -------- 
+// -------- HDDRSDRC2_DELAY4 : (HDDRSDRC2 Offset: 0x3c) Pad delay4 Register -------- 
+// -------- HDDRSDRC2_DELAY5 : (HDDRSDRC2 Offset: 0x40) Pad delay5 Register -------- 
+// -------- HDDRSDRC2_DELAY6 : (HDDRSDRC2 Offset: 0x44) Pad delay6 Register -------- 
+// -------- HDDRSDRC2_DELAY7 : (HDDRSDRC2 Offset: 0x48) Pad delay7 Register -------- 
+// -------- HDDRSDRC2_DELAY8 : (HDDRSDRC2 Offset: 0x4c) Pad delay8 Register -------- 
+// -------- HDDRSDRC2_WPMR : (HDDRSDRC2 Offset: 0xe4) Write Protect Mode Register -------- 
+#define AT91C_DDRC2_WPEN      (0x1 <<  0) // (HDDRSDRC2) write protect enable
+#define 	AT91C_DDRC2_WPEN_DISABLE              (0x0) // (HDDRSDRC2) 0 = Disables the Write Protect if WPKEY corresponds to 0x444452 (“DDR” in ASCII).
+#define 	AT91C_DDRC2_WPEN_ENABLE               (0x1) // (HDDRSDRC2) 1 = Enables the Write Protect if WPKEY corresponds to 0x444452 (“DDR” in ASCII).
+#define AT91C_DDRC2_WPKEY     (0xFFFFFF <<  8) // (HDDRSDRC2) write protect key
+// -------- HDDRSDRC2_WPSR : (HDDRSDRC2 Offset: 0xe8) Write Protect Status Register -------- 
+#define AT91C_DDRC2_WPVS      (0x1 <<  0) // (HDDRSDRC2) write protect violation status
+#define 	AT91C_DDRC2_WPVS_NO                   (0x0) // (HDDRSDRC2) 0 = No Write Protect Violation has occurred since the last read of the DDRSDRC_WPSR register.
+#define 	AT91C_DDRC2_WPVS_YES                  (0x1) // (HDDRSDRC2) A Write Protect Violation has occurred since the last read of the DDRSDRC_WPSR register.
+#define AT91C_DDRC2_WPVSRC    (0xFFFF <<  8) // (HDDRSDRC2) Write Protect Violation Source
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Static Memory Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_SMC {
+	AT91_REG	 SMC_SETUP0; 	//  Setup Register for CS 0
+	AT91_REG	 SMC_PULSE0; 	//  Pulse Register for CS 0
+	AT91_REG	 SMC_CYCLE0; 	//  Cycle Register for CS 0
+	AT91_REG	 SMC_CTRL0; 	//  Control Register for CS 0
+	AT91_REG	 SMC_SETUP1; 	//  Setup Register for CS 1
+	AT91_REG	 SMC_PULSE1; 	//  Pulse Register for CS 1
+	AT91_REG	 SMC_CYCLE1; 	//  Cycle Register for CS 1
+	AT91_REG	 SMC_CTRL1; 	//  Control Register for CS 1
+	AT91_REG	 SMC_SETUP2; 	//  Setup Register for CS 2
+	AT91_REG	 SMC_PULSE2; 	//  Pulse Register for CS 2
+	AT91_REG	 SMC_CYCLE2; 	//  Cycle Register for CS 2
+	AT91_REG	 SMC_CTRL2; 	//  Control Register for CS 2
+	AT91_REG	 SMC_SETUP3; 	//  Setup Register for CS 3
+	AT91_REG	 SMC_PULSE3; 	//  Pulse Register for CS 3
+	AT91_REG	 SMC_CYCLE3; 	//  Cycle Register for CS 3
+	AT91_REG	 SMC_CTRL3; 	//  Control Register for CS 3
+	AT91_REG	 SMC_SETUP4; 	//  Setup Register for CS 4
+	AT91_REG	 SMC_PULSE4; 	//  Pulse Register for CS 4
+	AT91_REG	 SMC_CYCLE4; 	//  Cycle Register for CS 4
+	AT91_REG	 SMC_CTRL4; 	//  Control Register for CS 4
+	AT91_REG	 SMC_SETUP5; 	//  Setup Register for CS 5
+	AT91_REG	 SMC_PULSE5; 	//  Pulse Register for CS 5
+	AT91_REG	 SMC_CYCLE5; 	//  Cycle Register for CS 5
+	AT91_REG	 SMC_CTRL5; 	//  Control Register for CS 5
+	AT91_REG	 SMC_SETUP6; 	//  Setup Register for CS 6
+	AT91_REG	 SMC_PULSE6; 	//  Pulse Register for CS 6
+	AT91_REG	 SMC_CYCLE6; 	//  Cycle Register for CS 6
+	AT91_REG	 SMC_CTRL6; 	//  Control Register for CS 6
+	AT91_REG	 SMC_SETUP7; 	//  Setup Register for CS 7
+	AT91_REG	 SMC_PULSE7; 	//  Pulse Register for CS 7
+	AT91_REG	 SMC_CYCLE7; 	//  Cycle Register for CS 7
+	AT91_REG	 SMC_CTRL7; 	//  Control Register for CS 7
+	AT91_REG	 Reserved0[16]; 	// 
+	AT91_REG	 SMC_DELAY1; 	// SMC Delay Control Register
+	AT91_REG	 SMC_DELAY2; 	// SMC Delay Control Register
+	AT91_REG	 SMC_DELAY3; 	// SMC Delay Control Register
+	AT91_REG	 SMC_DELAY4; 	// SMC Delay Control Register
+	AT91_REG	 SMC_DELAY5; 	// SMC Delay Control Register
+	AT91_REG	 SMC_DELAY6; 	// SMC Delay Control Register
+	AT91_REG	 SMC_DELAY7; 	// SMC Delay Control Register
+	AT91_REG	 SMC_DELAY8; 	// SMC Delay Control Register
+} AT91S_SMC, *AT91PS_SMC;
+#else
+#define SETUP0          (AT91_CAST(AT91_REG *) 	0x00000000) // (SETUP0)  Setup Register for CS 0
+#define PULSE0          (AT91_CAST(AT91_REG *) 	0x00000004) // (PULSE0)  Pulse Register for CS 0
+#define CYCLE0          (AT91_CAST(AT91_REG *) 	0x00000008) // (CYCLE0)  Cycle Register for CS 0
+#define CTRL0           (AT91_CAST(AT91_REG *) 	0x0000000C) // (CTRL0)  Control Register for CS 0
+#define SETUP1          (AT91_CAST(AT91_REG *) 	0x00000010) // (SETUP1)  Setup Register for CS 1
+#define PULSE1          (AT91_CAST(AT91_REG *) 	0x00000014) // (PULSE1)  Pulse Register for CS 1
+#define CYCLE1          (AT91_CAST(AT91_REG *) 	0x00000018) // (CYCLE1)  Cycle Register for CS 1
+#define CTRL1           (AT91_CAST(AT91_REG *) 	0x0000001C) // (CTRL1)  Control Register for CS 1
+#define SETUP2          (AT91_CAST(AT91_REG *) 	0x00000020) // (SETUP2)  Setup Register for CS 2
+#define PULSE2          (AT91_CAST(AT91_REG *) 	0x00000024) // (PULSE2)  Pulse Register for CS 2
+#define CYCLE2          (AT91_CAST(AT91_REG *) 	0x00000028) // (CYCLE2)  Cycle Register for CS 2
+#define CTRL2           (AT91_CAST(AT91_REG *) 	0x0000002C) // (CTRL2)  Control Register for CS 2
+#define SETUP3          (AT91_CAST(AT91_REG *) 	0x00000030) // (SETUP3)  Setup Register for CS 3
+#define PULSE3          (AT91_CAST(AT91_REG *) 	0x00000034) // (PULSE3)  Pulse Register for CS 3
+#define CYCLE3          (AT91_CAST(AT91_REG *) 	0x00000038) // (CYCLE3)  Cycle Register for CS 3
+#define CTRL3           (AT91_CAST(AT91_REG *) 	0x0000003C) // (CTRL3)  Control Register for CS 3
+#define SETUP4          (AT91_CAST(AT91_REG *) 	0x00000040) // (SETUP4)  Setup Register for CS 4
+#define PULSE4          (AT91_CAST(AT91_REG *) 	0x00000044) // (PULSE4)  Pulse Register for CS 4
+#define CYCLE4          (AT91_CAST(AT91_REG *) 	0x00000048) // (CYCLE4)  Cycle Register for CS 4
+#define CTRL4           (AT91_CAST(AT91_REG *) 	0x0000004C) // (CTRL4)  Control Register for CS 4
+#define SETUP5          (AT91_CAST(AT91_REG *) 	0x00000050) // (SETUP5)  Setup Register for CS 5
+#define PULSE5          (AT91_CAST(AT91_REG *) 	0x00000054) // (PULSE5)  Pulse Register for CS 5
+#define CYCLE5          (AT91_CAST(AT91_REG *) 	0x00000058) // (CYCLE5)  Cycle Register for CS 5
+#define CTRL5           (AT91_CAST(AT91_REG *) 	0x0000005C) // (CTRL5)  Control Register for CS 5
+#define SETUP6          (AT91_CAST(AT91_REG *) 	0x00000060) // (SETUP6)  Setup Register for CS 6
+#define PULSE6          (AT91_CAST(AT91_REG *) 	0x00000064) // (PULSE6)  Pulse Register for CS 6
+#define CYCLE6          (AT91_CAST(AT91_REG *) 	0x00000068) // (CYCLE6)  Cycle Register for CS 6
+#define CTRL6           (AT91_CAST(AT91_REG *) 	0x0000006C) // (CTRL6)  Control Register for CS 6
+#define SETUP7          (AT91_CAST(AT91_REG *) 	0x00000070) // (SETUP7)  Setup Register for CS 7
+#define PULSE7          (AT91_CAST(AT91_REG *) 	0x00000074) // (PULSE7)  Pulse Register for CS 7
+#define CYCLE7          (AT91_CAST(AT91_REG *) 	0x00000078) // (CYCLE7)  Cycle Register for CS 7
+#define CTRL7           (AT91_CAST(AT91_REG *) 	0x0000007C) // (CTRL7)  Control Register for CS 7
+#define DELAY1          (AT91_CAST(AT91_REG *) 	0x000000C0) // (DELAY1) SMC Delay Control Register
+#define DELAY2          (AT91_CAST(AT91_REG *) 	0x000000C4) // (DELAY2) SMC Delay Control Register
+#define DELAY3          (AT91_CAST(AT91_REG *) 	0x000000C8) // (DELAY3) SMC Delay Control Register
+#define DELAY4          (AT91_CAST(AT91_REG *) 	0x000000CC) // (DELAY4) SMC Delay Control Register
+#define DELAY5          (AT91_CAST(AT91_REG *) 	0x000000D0) // (DELAY5) SMC Delay Control Register
+#define DELAY6          (AT91_CAST(AT91_REG *) 	0x000000D4) // (DELAY6) SMC Delay Control Register
+#define DELAY7          (AT91_CAST(AT91_REG *) 	0x000000D8) // (DELAY7) SMC Delay Control Register
+#define DELAY8          (AT91_CAST(AT91_REG *) 	0x000000DC) // (DELAY8) SMC Delay Control Register
+
+#endif
+// -------- SMC_SETUP : (SMC Offset: 0x0) Setup Register for CS x -------- 
+#define AT91C_SMC_NWESETUP    (0x3F <<  0) // (SMC) NWE Setup Length
+#define AT91C_SMC_NCSSETUPWR  (0x3F <<  8) // (SMC) NCS Setup Length in WRite Access
+#define AT91C_SMC_NRDSETUP    (0x3F << 16) // (SMC) NRD Setup Length
+#define AT91C_SMC_NCSSETUPRD  (0x3F << 24) // (SMC) NCS Setup Length in ReaD Access
+// -------- SMC_PULSE : (SMC Offset: 0x4) Pulse Register for CS x -------- 
+#define AT91C_SMC_NWEPULSE    (0x7F <<  0) // (SMC) NWE Pulse Length
+#define AT91C_SMC_NCSPULSEWR  (0x7F <<  8) // (SMC) NCS Pulse Length in WRite Access
+#define AT91C_SMC_NRDPULSE    (0x7F << 16) // (SMC) NRD Pulse Length
+#define AT91C_SMC_NCSPULSERD  (0x7F << 24) // (SMC) NCS Pulse Length in ReaD Access
+// -------- SMC_CYC : (SMC Offset: 0x8) Cycle Register for CS x -------- 
+#define AT91C_SMC_NWECYCLE    (0x1FF <<  0) // (SMC) Total Write Cycle Length
+#define AT91C_SMC_NRDCYCLE    (0x1FF << 16) // (SMC) Total Read Cycle Length
+// -------- SMC_CTRL : (SMC Offset: 0xc) Control Register for CS x -------- 
+#define AT91C_SMC_READMODE    (0x1 <<  0) // (SMC) Read Mode
+#define AT91C_SMC_WRITEMODE   (0x1 <<  1) // (SMC) Write Mode
+#define AT91C_SMC_NWAITM      (0x3 <<  5) // (SMC) NWAIT Mode
+#define 	AT91C_SMC_NWAITM_NWAIT_DISABLE        (0x0 <<  5) // (SMC) External NWAIT disabled.
+#define 	AT91C_SMC_NWAITM_NWAIT_ENABLE_FROZEN  (0x2 <<  5) // (SMC) External NWAIT enabled in frozen mode.
+#define 	AT91C_SMC_NWAITM_NWAIT_ENABLE_READY   (0x3 <<  5) // (SMC) External NWAIT enabled in ready mode.
+#define AT91C_SMC_BAT         (0x1 <<  8) // (SMC) Byte Access Type
+#define 	AT91C_SMC_BAT_BYTE_SELECT          (0x0 <<  8) // (SMC) Write controled by ncs, nbs0, nbs1, nbs2, nbs3. Read controled by ncs, nrd, nbs0, nbs1, nbs2, nbs3.
+#define 	AT91C_SMC_BAT_BYTE_WRITE           (0x1 <<  8) // (SMC) Write controled by ncs, nwe0, nwe1, nwe2, nwe3. Read controled by ncs and nrd.
+#define AT91C_SMC_DBW         (0x3 << 12) // (SMC) Data Bus Width
+#define 	AT91C_SMC_DBW_WIDTH_EIGTH_BITS     (0x0 << 12) // (SMC) 8 bits.
+#define 	AT91C_SMC_DBW_WIDTH_SIXTEEN_BITS   (0x1 << 12) // (SMC) 16 bits.
+#define 	AT91C_SMC_DBW_WIDTH_THIRTY_TWO_BITS (0x2 << 12) // (SMC) 32 bits.
+#define AT91C_SMC_TDF         (0xF << 16) // (SMC) Data Float Time.
+#define AT91C_SMC_TDFEN       (0x1 << 20) // (SMC) TDF Enabled.
+#define AT91C_SMC_PMEN        (0x1 << 24) // (SMC) Page Mode Enabled.
+#define AT91C_SMC_PS          (0x3 << 28) // (SMC) Page Size
+#define 	AT91C_SMC_PS_SIZE_FOUR_BYTES      (0x0 << 28) // (SMC) 4 bytes.
+#define 	AT91C_SMC_PS_SIZE_EIGHT_BYTES     (0x1 << 28) // (SMC) 8 bytes.
+#define 	AT91C_SMC_PS_SIZE_SIXTEEN_BYTES   (0x2 << 28) // (SMC) 16 bytes.
+#define 	AT91C_SMC_PS_SIZE_THIRTY_TWO_BYTES (0x3 << 28) // (SMC) 32 bytes.
+// -------- SMC_SETUP : (SMC Offset: 0x10) Setup Register for CS x -------- 
+// -------- SMC_PULSE : (SMC Offset: 0x14) Pulse Register for CS x -------- 
+// -------- SMC_CYC : (SMC Offset: 0x18) Cycle Register for CS x -------- 
+// -------- SMC_CTRL : (SMC Offset: 0x1c) Control Register for CS x -------- 
+// -------- SMC_SETUP : (SMC Offset: 0x20) Setup Register for CS x -------- 
+// -------- SMC_PULSE : (SMC Offset: 0x24) Pulse Register for CS x -------- 
+// -------- SMC_CYC : (SMC Offset: 0x28) Cycle Register for CS x -------- 
+// -------- SMC_CTRL : (SMC Offset: 0x2c) Control Register for CS x -------- 
+// -------- SMC_SETUP : (SMC Offset: 0x30) Setup Register for CS x -------- 
+// -------- SMC_PULSE : (SMC Offset: 0x34) Pulse Register for CS x -------- 
+// -------- SMC_CYC : (SMC Offset: 0x38) Cycle Register for CS x -------- 
+// -------- SMC_CTRL : (SMC Offset: 0x3c) Control Register for CS x -------- 
+// -------- SMC_SETUP : (SMC Offset: 0x40) Setup Register for CS x -------- 
+// -------- SMC_PULSE : (SMC Offset: 0x44) Pulse Register for CS x -------- 
+// -------- SMC_CYC : (SMC Offset: 0x48) Cycle Register for CS x -------- 
+// -------- SMC_CTRL : (SMC Offset: 0x4c) Control Register for CS x -------- 
+// -------- SMC_SETUP : (SMC Offset: 0x50) Setup Register for CS x -------- 
+// -------- SMC_PULSE : (SMC Offset: 0x54) Pulse Register for CS x -------- 
+// -------- SMC_CYC : (SMC Offset: 0x58) Cycle Register for CS x -------- 
+// -------- SMC_CTRL : (SMC Offset: 0x5c) Control Register for CS x -------- 
+// -------- SMC_SETUP : (SMC Offset: 0x60) Setup Register for CS x -------- 
+// -------- SMC_PULSE : (SMC Offset: 0x64) Pulse Register for CS x -------- 
+// -------- SMC_CYC : (SMC Offset: 0x68) Cycle Register for CS x -------- 
+// -------- SMC_CTRL : (SMC Offset: 0x6c) Control Register for CS x -------- 
+// -------- SMC_SETUP : (SMC Offset: 0x70) Setup Register for CS x -------- 
+// -------- SMC_PULSE : (SMC Offset: 0x74) Pulse Register for CS x -------- 
+// -------- SMC_CYC : (SMC Offset: 0x78) Cycle Register for CS x -------- 
+// -------- SMC_CTRL : (SMC Offset: 0x7c) Control Register for CS x -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR AHB Matrix Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_MATRIX {
+	AT91_REG	 MATRIX_MCFG0; 	//  Master Configuration Register 0 : ARM-I
+	AT91_REG	 MATRIX_MCFG1; 	//  Master Configuration Register 1 ; ARM-D
+	AT91_REG	 MATRIX_MCFG2; 	//  Master Configuration Register 2 : pdc
+	AT91_REG	 MATRIX_MCFG3; 	//  Master Configuration Register 3 : USB Host OHCI
+	AT91_REG	 MATRIX_MCFG4; 	//  Master Configuration Register 4 : DMA0
+	AT91_REG	 MATRIX_MCFG5; 	//  Master Configuration Register 5 : DMA1
+	AT91_REG	 MATRIX_MCFG6; 	//  Master Configuration Register 6 : hisi
+	AT91_REG	 MATRIX_MCFG7; 	//  Master Configuration Register 7 : lcdc
+	AT91_REG	 MATRIX_MCFG8; 	//  Master Configuration Register 8 : eMAC
+	AT91_REG	 MATRIX_MCFG9; 	//  Master Configuration Register 9 : USB Device
+	AT91_REG	 MATRIX_MCFG10; 	//  Master Configuration Register 10 : USB Host EHCI
+	AT91_REG	 Reserved0[5]; 	// 
+	AT91_REG	 MATRIX_SCFG0; 	//  Slave Configuration Register 0 : SRAM S0
+	AT91_REG	 MATRIX_SCFG1; 	//  Slave Configuration Register 1 : SRAM S1
+	AT91_REG	 MATRIX_SCFG2; 	//  Slave Configuration Register 2 : SRAM S2
+	AT91_REG	 MATRIX_SCFG3; 	//  Slave Configuration Register 3 : SRAM S3
+	AT91_REG	 MATRIX_SCFG4; 	//  Slave Configuration Register 4 ; ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+	AT91_REG	 MATRIX_SCFG5; 	//  Slave Configuration Register 5 : DDR2 S0
+	AT91_REG	 MATRIX_SCFG6; 	//  Slave Configuration Register 6 : DDR2 S1
+	AT91_REG	 MATRIX_SCFG7; 	//  Slave Configuration Register 7 : DDR2 S2
+	AT91_REG	 Reserved1[8]; 	// 
+	AT91_REG	 MATRIX_PRAS0; 	//  PRAS0 : SRAM S0
+	AT91_REG	 MATRIX_PRBS0; 	//  PRBS0 : SRAM S0
+	AT91_REG	 MATRIX_PRAS1; 	//  PRAS1 : SRAM S1
+	AT91_REG	 MATRIX_PRBS1; 	//  PRBS1 : SRAM S1
+	AT91_REG	 MATRIX_PRAS2; 	//  PRAS2 : SRAM S2
+	AT91_REG	 MATRIX_PRBS2; 	//  PRBS2 : SRAM S2
+	AT91_REG	 MATRIX_PRAS3; 	//  PRAS3 : SRAM S3
+	AT91_REG	 MATRIX_PRBS3; 	//  PRBS3 : SRAM S3
+	AT91_REG	 MATRIX_PRAS4; 	//  PRAS4 : ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+	AT91_REG	 MATRIX_PRBS4; 	//  PRBS4 : ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+	AT91_REG	 MATRIX_PRAS5; 	//  PRAS5 : DDR2 S0
+	AT91_REG	 MATRIX_PRBS5; 	//  PRBS5 : DDR2 S0
+	AT91_REG	 MATRIX_PRAS6; 	//  PRAS6 : DDR2 S1
+	AT91_REG	 MATRIX_PRBS6; 	//  PRBS6 : DDR2 S1
+	AT91_REG	 MATRIX_PRAS7; 	//  PRAS7 : DDR2 S2
+	AT91_REG	 MATRIX_PRBS7; 	//  PRBS7 : DDR2 S2
+	AT91_REG	 Reserved2[16]; 	// 
+	AT91_REG	 MATRIX_MRCR; 	//  Master Remap Control Register 
+	AT91_REG	 Reserved3[3]; 	// 
+	AT91_REG	 MATRIX_TCMR; 	//  Bus Matrix TCM Configuration Register 
+	AT91_REG	 Reserved4[1]; 	// 
+	AT91_REG	 MATRIX_DDRMPR; 	//  DDR Multi-Port Register 
+	AT91_REG	 Reserved5[3]; 	// 
+	AT91_REG	 MATRIX_EBICSA; 	//  EBI Chip Select Assignment Register 
+	AT91_REG	 Reserved6[46]; 	// 
+	AT91_REG	 MATRIX_WRPROTEN; 	//  Write Protection Control Register 
+	AT91_REG	 MATRIX_WRPROTST; 	//  Write Protection Status Register 
+} AT91S_MATRIX, *AT91PS_MATRIX;
+#else
+#define MATRIX_MCFG0    (AT91_CAST(AT91_REG *) 	0x00000000) // (MATRIX_MCFG0)  Master Configuration Register 0 : ARM-I
+#define MATRIX_MCFG1    (AT91_CAST(AT91_REG *) 	0x00000004) // (MATRIX_MCFG1)  Master Configuration Register 1 ; ARM-D
+#define MATRIX_MCFG2    (AT91_CAST(AT91_REG *) 	0x00000008) // (MATRIX_MCFG2)  Master Configuration Register 2 : pdc
+#define MATRIX_MCFG3    (AT91_CAST(AT91_REG *) 	0x0000000C) // (MATRIX_MCFG3)  Master Configuration Register 3 : USB Host OHCI
+#define MATRIX_MCFG4    (AT91_CAST(AT91_REG *) 	0x00000010) // (MATRIX_MCFG4)  Master Configuration Register 4 : DMA0
+#define MATRIX_MCFG5    (AT91_CAST(AT91_REG *) 	0x00000014) // (MATRIX_MCFG5)  Master Configuration Register 5 : DMA1
+#define MATRIX_MCFG6    (AT91_CAST(AT91_REG *) 	0x00000018) // (MATRIX_MCFG6)  Master Configuration Register 6 : hisi
+#define MATRIX_MCFG7    (AT91_CAST(AT91_REG *) 	0x0000001C) // (MATRIX_MCFG7)  Master Configuration Register 7 : lcdc
+#define MATRIX_MCFG8    (AT91_CAST(AT91_REG *) 	0x00000020) // (MATRIX_MCFG8)  Master Configuration Register 8 : eMAC
+#define MATRIX_MCFG9    (AT91_CAST(AT91_REG *) 	0x00000024) // (MATRIX_MCFG9)  Master Configuration Register 9 : USB Device
+#define MATRIX_MCFG10   (AT91_CAST(AT91_REG *) 	0x00000028) // (MATRIX_MCFG10)  Master Configuration Register 10 : USB Host EHCI
+#define MATRIX_SCFG0    (AT91_CAST(AT91_REG *) 	0x00000040) // (MATRIX_SCFG0)  Slave Configuration Register 0 : SRAM S0
+#define MATRIX_SCFG1    (AT91_CAST(AT91_REG *) 	0x00000044) // (MATRIX_SCFG1)  Slave Configuration Register 1 : SRAM S1
+#define MATRIX_SCFG2    (AT91_CAST(AT91_REG *) 	0x00000048) // (MATRIX_SCFG2)  Slave Configuration Register 2 : SRAM S2
+#define MATRIX_SCFG3    (AT91_CAST(AT91_REG *) 	0x0000004C) // (MATRIX_SCFG3)  Slave Configuration Register 3 : SRAM S3
+#define MATRIX_SCFG4    (AT91_CAST(AT91_REG *) 	0x00000050) // (MATRIX_SCFG4)  Slave Configuration Register 4 ; ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+#define MATRIX_SCFG5    (AT91_CAST(AT91_REG *) 	0x00000054) // (MATRIX_SCFG5)  Slave Configuration Register 5 : DDR2 S0
+#define MATRIX_SCFG6    (AT91_CAST(AT91_REG *) 	0x00000058) // (MATRIX_SCFG6)  Slave Configuration Register 6 : DDR2 S1
+#define MATRIX_SCFG7    (AT91_CAST(AT91_REG *) 	0x0000005C) // (MATRIX_SCFG7)  Slave Configuration Register 7 : DDR2 S2
+#define MATRIX_PRAS0    (AT91_CAST(AT91_REG *) 	0x00000080) // (MATRIX_PRAS0)  PRAS0 : SRAM S0
+#define MATRIX_PRBS0    (AT91_CAST(AT91_REG *) 	0x00000084) // (MATRIX_PRBS0)  PRBS0 : SRAM S0
+#define MATRIX_PRAS1    (AT91_CAST(AT91_REG *) 	0x00000088) // (MATRIX_PRAS1)  PRAS1 : SRAM S1
+#define MATRIX_PRBS1    (AT91_CAST(AT91_REG *) 	0x0000008C) // (MATRIX_PRBS1)  PRBS1 : SRAM S1
+#define MATRIX_PRAS2    (AT91_CAST(AT91_REG *) 	0x00000090) // (MATRIX_PRAS2)  PRAS2 : SRAM S2
+#define MATRIX_PRBS2    (AT91_CAST(AT91_REG *) 	0x00000094) // (MATRIX_PRBS2)  PRBS2 : SRAM S2
+#define MATRIX_PRAS3    (AT91_CAST(AT91_REG *) 	0x00000098) // (MATRIX_PRAS3)  PRAS3 : SRAM S3
+#define MATRIX_PRBS3    (AT91_CAST(AT91_REG *) 	0x0000009C) // (MATRIX_PRBS3)  PRBS3 : SRAM S3
+#define MATRIX_PRAS4    (AT91_CAST(AT91_REG *) 	0x000000A0) // (MATRIX_PRAS4)  PRAS4 : ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+#define MATRIX_PRBS4    (AT91_CAST(AT91_REG *) 	0x000000A4) // (MATRIX_PRBS4)  PRBS4 : ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+#define MATRIX_PRAS5    (AT91_CAST(AT91_REG *) 	0x000000A8) // (MATRIX_PRAS5)  PRAS5 : DDR2 S0
+#define MATRIX_PRBS5    (AT91_CAST(AT91_REG *) 	0x000000AC) // (MATRIX_PRBS5)  PRBS5 : DDR2 S0
+#define MATRIX_PRAS6    (AT91_CAST(AT91_REG *) 	0x000000B0) // (MATRIX_PRAS6)  PRAS6 : DDR2 S1
+#define MATRIX_PRBS6    (AT91_CAST(AT91_REG *) 	0x000000B4) // (MATRIX_PRBS6)  PRBS6 : DDR2 S1
+#define MATRIX_PRAS7    (AT91_CAST(AT91_REG *) 	0x000000B8) // (MATRIX_PRAS7)  PRAS7 : DDR2 S2
+#define MATRIX_PRBS7    (AT91_CAST(AT91_REG *) 	0x000000BC) // (MATRIX_PRBS7)  PRBS7 : DDR2 S2
+#define MATRIX_MRCR     (AT91_CAST(AT91_REG *) 	0x00000100) // (MATRIX_MRCR)  Master Remap Control Register 
+#define HMATRIX_CCFG_TCMR (AT91_CAST(AT91_REG *) 	0x00000110) // (HMATRIX_CCFG_TCMR)  Bus Matrix TCM Configuration Register 
+#define HMATRIX_CCFG_DDRMPR (AT91_CAST(AT91_REG *) 	0x00000118) // (HMATRIX_CCFG_DDRMPR)  DDR Multi-Port Register 
+#define HMATRIX_CCFG_EBICSA (AT91_CAST(AT91_REG *) 	0x00000128) // (HMATRIX_CCFG_EBICSA)  EBI Chip Select Assignment Register 
+#define MATRIX_WRPROTEN (AT91_CAST(AT91_REG *) 	0x000001E4) // (MATRIX_WRPROTEN)  Write Protection Control Register 
+#define MATRIX_WRPROTST (AT91_CAST(AT91_REG *) 	0x000001E8) // (MATRIX_WRPROTST)  Write Protection Status Register 
+
+#endif
+// -------- MATRIX_MCFG0 : (MATRIX Offset: 0x0) Master Configuration Register ARM-I -------- 
+#define AT91C_MATRIX_ULBT     (0x7 <<  0) // (MATRIX) Undefined Length Burst Type
+// -------- MATRIX_MCFG1 : (MATRIX Offset: 0x4) Master Configuration Register ARM-D -------- 
+// -------- MATRIX_MCFG2 : (MATRIX Offset: 0x8) Master Configuration Register PDC -------- 
+// -------- MATRIX_MCFG3 : (MATRIX Offset: 0xc) Master Configuration Register USB Host OHCI -------- 
+// -------- MATRIX_MCFG4 : (MATRIX Offset: 0x10) Master Configuration Register DMA0 -------- 
+// -------- MATRIX_MCFG5 : (MATRIX Offset: 0x14) Master Configuration Register DMA1 -------- 
+// -------- MATRIX_MCFG6 : (MATRIX Offset: 0x18) Master Configuration Register HISI -------- 
+// -------- MATRIX_MCFG7 : (MATRIX Offset: 0x1c) Master Configuration Register LCD -------- 
+// -------- MATRIX_MCFG8 : (MATRIX Offset: 0x20) Master Configuration Register EMAC -------- 
+// -------- MATRIX_MCFG9 : (MATRIX Offset: 0x24) Master Configuration Register USB Device -------- 
+// -------- MATRIX_MCFG10 : (MATRIX Offset: 0x28) Master Configuration Register USB Host EHCI -------- 
+// -------- MATRIX_SCFG0 : (MATRIX Offset: 0x40) Slave Configuration Register 0 -------- 
+#define AT91C_MATRIX_SLOT_CYCLE (0xFF <<  0) // (MATRIX) Maximum Number of Allowed Cycles for a Burst
+#define AT91C_MATRIX_DEFMSTR_TYPE (0x3 << 16) // (MATRIX) Default Master Type
+#define 	AT91C_MATRIX_DEFMSTR_TYPE_NO_DEFMSTR           (0x0 << 16) // (MATRIX) No Default Master. At the end of current slave access, if no other master request is pending, the slave is deconnected from all masters. This results in having a one cycle latency for the first transfer of a burst.
+#define 	AT91C_MATRIX_DEFMSTR_TYPE_LAST_DEFMSTR         (0x1 << 16) // (MATRIX) Last Default Master. At the end of current slave access, if no other master request is pending, the slave stay connected with the last master having accessed it. This results in not having the one cycle latency when the last master re-trying access on the slave.
+#define 	AT91C_MATRIX_DEFMSTR_TYPE_FIXED_DEFMSTR        (0x2 << 16) // (MATRIX) Fixed Default Master. At the end of current slave access, if no other master request is pending, the slave connects with fixed which number is in FIXED_DEFMSTR field. This results in not having the one cycle latency when the fixed master re-trying access on the slave.
+#define AT91C_MATRIX_FIXED_DEFMSTR0 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_ARM926I              (0x0 << 18) // (MATRIX) ARM926EJ-S Instruction Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_ARM926D              (0x1 << 18) // (MATRIX) ARM926EJ-S Data Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_PDC                  (0x2 << 18) // (MATRIX) PDC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_UHPHS_OHCI           (0x3 << 18) // (MATRIX) USB Host OHCI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_DMA0                 (0x4 << 18) // (MATRIX) DMA0 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_DMA1                 (0x5 << 18) // (MATRIX) DMA1 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_ISI                  (0x6 << 18) // (MATRIX) ISI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_EMAC                 (0x8 << 18) // (MATRIX) EMAC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_UDPHS                (0x9 << 18) // (MATRIX) USB Device Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR0_UHPHS_EHCI           (0xA << 18) // (MATRIX) USB Host EHCI Master is Default Master
+#define AT91C_MATRIX_ARBT     (0x3 << 24) // (MATRIX) Arbitration Type
+// -------- MATRIX_SCFG1 : (MATRIX Offset: 0x44) Slave Configuration Register 1 -------- 
+#define AT91C_MATRIX_FIXED_DEFMSTR1 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR1_ARM926I              (0x0 << 18) // (MATRIX) ARM926EJ-S Instruction Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR1_ARM926D              (0x1 << 18) // (MATRIX) ARM926EJ-S Data Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR1_PDC                  (0x2 << 18) // (MATRIX) PDC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR1_ISI                  (0x6 << 18) // (MATRIX) ISI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR1_UDPHS                (0x9 << 18) // (MATRIX) USB Device Master is Default Master
+// -------- MATRIX_SCFG2 : (MATRIX Offset: 0x48) Slave Configuration Register 2 -------- 
+#define AT91C_MATRIX_FIXED_DEFMSTR2 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR2_ARM926I              (0x0 << 18) // (MATRIX) ARM926EJ-S Instruction Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR2_VDEC                 (0xB << 18) // (MATRIX) Video Decoder Master is Default Master
+// -------- MATRIX_SCFG3 : (MATRIX Offset: 0x4c) Slave Configuration Register 3 -------- 
+#define AT91C_MATRIX_FIXED_DEFMSTR3 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR3_ARM926D              (0x1 << 18) // (MATRIX) ARM926EJ-S Data Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR3_LCD                  (0x7 << 18) // (MATRIX) LCD Master is Default Master
+// -------- MATRIX_SCFG4 : (MATRIX Offset: 0x50) Slave Configuration Register 4 -------- 
+#define AT91C_MATRIX_FIXED_DEFMSTR4 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_ARM926I              (0x0 << 18) // (MATRIX) ARM926EJ-S Instruction Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_PDC                  (0x2 << 18) // (MATRIX) PDC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_UHPHS_OHCI           (0x3 << 18) // (MATRIX) USB Host OHCI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_DMA0                 (0x4 << 18) // (MATRIX) DMA0 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_DMA1                 (0x5 << 18) // (MATRIX) DMA1 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_ISI                  (0x6 << 18) // (MATRIX) ISI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_EMAC                 (0x8 << 18) // (MATRIX) EMAC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_UDPHS                (0x9 << 18) // (MATRIX) USB Device Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR4_UHPHS_EHCI           (0xA << 18) // (MATRIX) USB Host EHCI Master is Default Master
+// -------- MATRIX_SCFG5 : (MATRIX Offset: 0x54) Slave Configuration Register 5 -------- 
+#define AT91C_MATRIX_FIXED_DEFMSTR5 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_ARM926D              (0x1 << 18) // (MATRIX) ARM926EJ-S Data Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_PDC                  (0x2 << 18) // (MATRIX) PDC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_UHPHS_OHCI           (0x3 << 18) // (MATRIX) USB Host OHCI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_DMA0                 (0x4 << 18) // (MATRIX) DMA0 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_DMA1                 (0x5 << 18) // (MATRIX) DMA1 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_ISI                  (0x6 << 18) // (MATRIX) ISI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_EMAC                 (0x8 << 18) // (MATRIX) EMAC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_UDPHS                (0x9 << 18) // (MATRIX) USB Device Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR5_UHPHS_EHCI           (0xA << 18) // (MATRIX) USB Host EHCI Master is Default Master
+// -------- MATRIX_SCFG6 : (MATRIX Offset: 0x58) Slave Configuration Register 6 -------- 
+#define AT91C_MATRIX_FIXED_DEFMSTR6 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_ARM926I              (0x0 << 18) // (MATRIX) ARM926EJ-S Instruction Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_ARM926D              (0x1 << 18) // (MATRIX) ARM926EJ-S Data Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_PDC                  (0x2 << 18) // (MATRIX) PDC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_UHPHS_OHCI           (0x3 << 18) // (MATRIX) USB Host OHCI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_DMA0                 (0x4 << 18) // (MATRIX) DMA0 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_DMA1                 (0x5 << 18) // (MATRIX) DMA1 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_ISI                  (0x6 << 18) // (MATRIX) ISI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_LCD                  (0x7 << 18) // (MATRIX) LCD Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_EMAC                 (0x8 << 18) // (MATRIX) EMAC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_UDPHS                (0x9 << 18) // (MATRIX) USB Device Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_UHPHS_EHCI           (0xA << 18) // (MATRIX) USB Host EHCI Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR6_VDEC                 (0xB << 18) // (MATRIX) Video Decoder Master is Default Master
+// -------- MATRIX_SCFG7 : (MATRIX Offset: 0x5c) Slave Configuration Register 7 -------- 
+#define AT91C_MATRIX_FIXED_DEFMSTR7 (0xF << 18) // (MATRIX) Fixed Index of Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR7_ARM926I              (0x0 << 18) // (MATRIX) ARM926EJ-S Instruction Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR7_ARM926D              (0x1 << 18) // (MATRIX) ARM926EJ-S Data Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR7_PDC                  (0x2 << 18) // (MATRIX) PDC Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR7_DMA0                 (0x4 << 18) // (MATRIX) DMA0 Master is Default Master
+#define 	AT91C_MATRIX_FIXED_DEFMSTR7_DMA1                 (0x5 << 18) // (MATRIX) DMA1 Master is Default Master
+// -------- MATRIX_PRAS0 : (MATRIX Offset: 0x80) PRAS0 Register -------- 
+#define AT91C_MATRIX_M0PR     (0x3 <<  0) // (MATRIX) ARM926EJ-S Instruction priority
+#define AT91C_MATRIX_M1PR     (0x3 <<  4) // (MATRIX) ARM926EJ-S Data priority
+#define AT91C_MATRIX_M2PR     (0x3 <<  8) // (MATRIX) PDC priority
+#define AT91C_MATRIX_M3PR     (0x3 << 12) // (MATRIX) USB Host OHCI priority
+#define AT91C_MATRIX_M4PR     (0x3 << 16) // (MATRIX) DMA0 priority
+#define AT91C_MATRIX_M5PR     (0x3 << 20) // (MATRIX) DMA1 priority
+#define AT91C_MATRIX_M6PR     (0x3 << 24) // (MATRIX) ISI priority
+#define AT91C_MATRIX_M7PR     (0x3 << 28) // (MATRIX) LCD priority
+// -------- MATRIX_PRBS0 : (MATRIX Offset: 0x84) PRBS0 Register -------- 
+#define AT91C_MATRIX_M8PR     (0x3 <<  0) // (MATRIX) EMAC priority
+#define AT91C_MATRIX_M9PR     (0x3 <<  4) // (MATRIX) USB Device priority
+#define AT91C_MATRIX_M10PR    (0x3 <<  8) // (MATRIX) USB Host EHCI priority
+#define AT91C_MATRIX_M11PR    (0x3 << 12) // (MATRIX) Video Decoder priority
+// -------- MATRIX_PRAS1 : (MATRIX Offset: 0x88) PRAS1 Register -------- 
+// -------- MATRIX_PRBS1 : (MATRIX Offset: 0x8c) PRBS1 Register -------- 
+// -------- MATRIX_PRAS2 : (MATRIX Offset: 0x90) PRAS2 Register -------- 
+// -------- MATRIX_PRBS2 : (MATRIX Offset: 0x94) PRBS2 Register -------- 
+// -------- MATRIX_PRAS3 : (MATRIX Offset: 0x98) PRAS3 Register -------- 
+// -------- MATRIX_PRBS3 : (MATRIX Offset: 0x9c) PRBS3 Register -------- 
+// -------- MATRIX_PRAS4 : (MATRIX Offset: 0xa0) PRAS4 Register -------- 
+// -------- MATRIX_PRBS4 : (MATRIX Offset: 0xa4) PRBS4 Register -------- 
+// -------- MATRIX_PRAS5 : (MATRIX Offset: 0xa8) PRAS5 Register -------- 
+// -------- MATRIX_PRBS5 : (MATRIX Offset: 0xac) PRBS5 Register -------- 
+// -------- MATRIX_PRAS6 : (MATRIX Offset: 0xb0) PRAS6 Register -------- 
+// -------- MATRIX_PRBS6 : (MATRIX Offset: 0xb4) PRBS6 Register -------- 
+// -------- MATRIX_PRAS7 : (MATRIX Offset: 0xb8) PRAS7 Register -------- 
+// -------- MATRIX_PRBS7 : (MATRIX Offset: 0xbc) PRBS7 Register -------- 
+// -------- MATRIX_MRCR : (MATRIX Offset: 0x100) MRCR Register -------- 
+#define AT91C_MATRIX_RCA926I  (0x1 <<  0) // (MATRIX) Remap Command Bit for ARM926EJ-S Instruction
+#define AT91C_MATRIX_RCA926D  (0x1 <<  1) // (MATRIX) Remap Command Bit for ARM926EJ-S Data
+#define AT91C_MATRIX_RCB2     (0x1 <<  2) // (MATRIX) Remap Command Bit for PDC
+#define AT91C_MATRIX_RCB3     (0x1 <<  3) // (MATRIX) Remap Command Bit for USB Host OHCI
+#define AT91C_MATRIX_RCB4     (0x1 <<  4) // (MATRIX) Remap Command Bit for DMA0
+#define AT91C_MATRIX_RCB5     (0x1 <<  5) // (MATRIX) Remap Command Bit for DMA1
+#define AT91C_MATRIX_RCB6     (0x1 <<  6) // (MATRIX) Remap Command Bit for ISI
+#define AT91C_MATRIX_RCB7     (0x1 <<  7) // (MATRIX) Remap Command Bit for LCD
+#define AT91C_MATRIX_RCB8     (0x1 <<  8) // (MATRIX) Remap Command Bit for EMAC
+#define AT91C_MATRIX_RCB9     (0x1 <<  9) // (MATRIX) Remap Command Bit for USB Device
+#define AT91C_MATRIX_RCB10    (0x1 << 10) // (MATRIX) Remap Command Bit for USB Host EHCI
+#define AT91C_MATRIX_RCB11    (0x1 << 11) // (MATRIX) Remap Command Bit for Video Decoder
+// -------- HMATRIX_CCFG_TCMR : (MATRIX Offset: 0x110) TCMR Register -------- 
+#define AT91C_ITCM_SIZE       (0xF <<  0) // (MATRIX) Size of ITCM enabled memory block
+#define 	AT91C_ITCM_SIZE_0KB                  (0x0) // (MATRIX) 0 KB (No ITCM Memory)
+#define 	AT91C_ITCM_SIZE_32KB                 (0x6) // (MATRIX) 32 KB
+#define AT91C_DTCM_SIZE       (0xF <<  4) // (MATRIX) Size of DTCM enabled memory block
+#define 	AT91C_DTCM_SIZE_0KB                  (0x0 <<  4) // (MATRIX) 0 KB (No DTCM Memory)
+#define 	AT91C_DTCM_SIZE_32KB                 (0x6 <<  4) // (MATRIX) 32 KB
+#define 	AT91C_DTCM_SIZE_64KB                 (0x7 <<  4) // (MATRIX) 64 KB
+#define AT91C_TCM_NWS         (0x1 << 11) // (MATRIX) TCM Wait State
+#define 	AT91C_TCM_NWS_NO_WS                (0x0 << 11) // (MATRIX) NO WAIT STATE : 0 WS
+#define 	AT91C_TCM_NWS_ONE_WS               (0x1 << 11) // (MATRIX) 1 WS activated (only for RATIO 3:1 or 4:1
+// -------- HMATRIX_CCFG_DDRMPR : (MATRIX Offset: 0x118) DDR Multi-Port Register -------- 
+#define AT91C_DDRMP_DIS       (0x1 <<  0) // (MATRIX) DDR Multi-Port Disable
+// -------- HMATRIX_CCFG_EBICSA : (MATRIX Offset: 0x128) CCFG_EBICSA Register -------- 
+#define AT91C_EBI_CS1A        (0x1 <<  1) // (MATRIX) EBI Chip Select 1 Assignment
+#define 	AT91C_EBI_CS1A_SMC                  (0x0 <<  1) // (MATRIX) Chip Select 1 is assigned to the Static Memory Controller.
+#define 	AT91C_EBI_CS1A_SDRAMC               (0x1 <<  1) // (MATRIX) Chip Select 1 is assigned to the SDRAM Controller.
+#define AT91C_EBI_CS3A        (0x1 <<  3) // (MATRIX) EBI Chip Select 3 Assignment
+#define 	AT91C_EBI_CS3A_SMC                  (0x0 <<  3) // (MATRIX) Chip Select 3 is only assigned to the Static Memory Controller and NCS3 behaves as defined by the SMC.
+#define 	AT91C_EBI_CS3A_SM                   (0x1 <<  3) // (MATRIX) Chip Select 3 is assigned to the Static Memory Controller and the SmartMedia Logic is activated.
+#define AT91C_EBI_CS4A        (0x1 <<  4) // (MATRIX) EBI Chip Select 4 Assignment
+#define 	AT91C_EBI_CS4A_SMC                  (0x0 <<  4) // (MATRIX) Chip Select 4 is only assigned to the Static Memory Controller and NCS4 behaves as defined by the SMC.
+#define 	AT91C_EBI_CS4A_CF                   (0x1 <<  4) // (MATRIX) Chip Select 4 is assigned to the Static Memory Controller and the CompactFlash Logic (first slot) is activated.
+#define AT91C_EBI_CS5A        (0x1 <<  5) // (MATRIX) EBI Chip Select 5 Assignment
+#define 	AT91C_EBI_CS5A_SMC                  (0x0 <<  5) // (MATRIX) Chip Select 5 is only assigned to the Static Memory Controller and NCS5 behaves as defined by the SMC
+#define 	AT91C_EBI_CS5A_CF                   (0x1 <<  5) // (MATRIX) Chip Select 5 is assigned to the Static Memory Controller and the CompactFlash Logic (second slot) is activated.
+#define AT91C_EBI_DBPUC       (0x1 <<  8) // (MATRIX) EBI Data Bus Pull-Up Configuration
+#define AT91C_EBI_DRIVE       (0x3 << 16) // (MATRIX) EBI I/O Drive Configuration
+#define 	AT91C_EBI_DRIVE_18RD                 (0x0 << 16) // (MATRIX) optimized for 1.8V powered memories with Reduced Drive
+#define 	AT91C_EBI_DRIVE_33RD                 (0x1 << 16) // (MATRIX) optimized for 3.3V powered memories with Reduced Drive
+#define 	AT91C_EBI_DRIVE_18ND                 (0x2 << 16) // (MATRIX) optimized for 1.8V powered memories with Normal Drive
+#define 	AT91C_EBI_DRIVE_33ND                 (0x3 << 16) // (MATRIX) optimized for 3.3V powered memories with Normal Drive
+#define AT91C_DDR_DRIVE       (0x1 << 18) // (MATRIX) DDR2 dedicated port I/O slew rate selection
+// -------- MATRIX_WRPROTEN : (MATRIX Offset: 0x1e4) Write Protection Control Register -------- 
+#define AT91C_MATRIX_WRPROT   (0x1 <<  0) // (MATRIX) Enable/Disable Write Protection of HMATRIX2 configuration registers (requires key)
+#define 	AT91C_MATRIX_WRPROT_DISABLE              (0x0) // (MATRIX) Disable Write Protection of HMATRIX2 configuration registers
+#define 	AT91C_MATRIX_WRPROT_ENABLE               (0x1) // (MATRIX) Enable  Write Protection of HMATRIX2 configuration registers
+// -------- MATRIX_WRPROTST : (MATRIX Offset: 0x1e8) Write Protection Status Register -------- 
+#define AT91C_MATRIX_WRPROT_VIOLATION (0x1 <<  0) // (MATRIX) Violation of Write Protection of HMATRIX2 configuration registers
+#define 	AT91C_MATRIX_WRPROT_VIOLATION_UNDETECTED           (0x0) // (MATRIX) No violation of Write Protection of HMATRIX2 configuration registers
+#define 	AT91C_MATRIX_WRPROT_VIOLATION_DETECTED             (0x1) // (MATRIX) Violation of  Write Protection of HMATRIX2 configuration registers
+#define AT91C_MATRIX_WRPROT_VIOLATION_OFFSET (0x1FF <<  8) // (MATRIX) Offset where violation of Write Protection of HMATRIX2 configuration registers is detected
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Advanced Interrupt Controller
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_AIC {
+	AT91_REG	 AIC_SMR[32]; 	// Source Mode Register
+	AT91_REG	 AIC_SVR[32]; 	// Source Vector Register
+	AT91_REG	 AIC_IVR; 	// IRQ Vector Register
+	AT91_REG	 AIC_FVR; 	// FIQ Vector Register
+	AT91_REG	 AIC_ISR; 	// Interrupt Status Register
+	AT91_REG	 AIC_IPR; 	// Interrupt Pending Register
+	AT91_REG	 AIC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 AIC_CISR; 	// Core Interrupt Status Register
+	AT91_REG	 Reserved0[2]; 	// 
+	AT91_REG	 AIC_IECR; 	// Interrupt Enable Command Register
+	AT91_REG	 AIC_IDCR; 	// Interrupt Disable Command Register
+	AT91_REG	 AIC_ICCR; 	// Interrupt Clear Command Register
+	AT91_REG	 AIC_ISCR; 	// Interrupt Set Command Register
+	AT91_REG	 AIC_EOICR; 	// End of Interrupt Command Register
+	AT91_REG	 AIC_SPU; 	// Spurious Vector Register
+	AT91_REG	 AIC_DCR; 	// Debug Control Register (Protect)
+	AT91_REG	 Reserved1[1]; 	// 
+	AT91_REG	 AIC_FFER; 	// Fast Forcing Enable Register
+	AT91_REG	 AIC_FFDR; 	// Fast Forcing Disable Register
+	AT91_REG	 AIC_FFSR; 	// Fast Forcing Status Register
+} AT91S_AIC, *AT91PS_AIC;
+#else
+#define AIC_SMR         (AT91_CAST(AT91_REG *) 	0x00000000) // (AIC_SMR) Source Mode Register
+#define AIC_SVR         (AT91_CAST(AT91_REG *) 	0x00000080) // (AIC_SVR) Source Vector Register
+#define AIC_IVR         (AT91_CAST(AT91_REG *) 	0x00000100) // (AIC_IVR) IRQ Vector Register
+#define AIC_FVR         (AT91_CAST(AT91_REG *) 	0x00000104) // (AIC_FVR) FIQ Vector Register
+#define AIC_ISR         (AT91_CAST(AT91_REG *) 	0x00000108) // (AIC_ISR) Interrupt Status Register
+#define AIC_IPR         (AT91_CAST(AT91_REG *) 	0x0000010C) // (AIC_IPR) Interrupt Pending Register
+#define AIC_IMR         (AT91_CAST(AT91_REG *) 	0x00000110) // (AIC_IMR) Interrupt Mask Register
+#define AIC_CISR        (AT91_CAST(AT91_REG *) 	0x00000114) // (AIC_CISR) Core Interrupt Status Register
+#define AIC_IECR        (AT91_CAST(AT91_REG *) 	0x00000120) // (AIC_IECR) Interrupt Enable Command Register
+#define AIC_IDCR        (AT91_CAST(AT91_REG *) 	0x00000124) // (AIC_IDCR) Interrupt Disable Command Register
+#define AIC_ICCR        (AT91_CAST(AT91_REG *) 	0x00000128) // (AIC_ICCR) Interrupt Clear Command Register
+#define AIC_ISCR        (AT91_CAST(AT91_REG *) 	0x0000012C) // (AIC_ISCR) Interrupt Set Command Register
+#define AIC_EOICR       (AT91_CAST(AT91_REG *) 	0x00000130) // (AIC_EOICR) End of Interrupt Command Register
+#define AIC_SPU         (AT91_CAST(AT91_REG *) 	0x00000134) // (AIC_SPU) Spurious Vector Register
+#define AIC_DCR         (AT91_CAST(AT91_REG *) 	0x00000138) // (AIC_DCR) Debug Control Register (Protect)
+#define AIC_FFER        (AT91_CAST(AT91_REG *) 	0x00000140) // (AIC_FFER) Fast Forcing Enable Register
+#define AIC_FFDR        (AT91_CAST(AT91_REG *) 	0x00000144) // (AIC_FFDR) Fast Forcing Disable Register
+#define AIC_FFSR        (AT91_CAST(AT91_REG *) 	0x00000148) // (AIC_FFSR) Fast Forcing Status Register
+
+#endif
+// -------- AIC_SMR : (AIC Offset: 0x0) Control Register -------- 
+#define AT91C_AIC_PRIOR       (0x7 <<  0) // (AIC) Priority Level
+#define 	AT91C_AIC_PRIOR_LOWEST               (0x0) // (AIC) Lowest priority level
+#define 	AT91C_AIC_PRIOR_HIGHEST              (0x7) // (AIC) Highest priority level
+#define AT91C_AIC_SRCTYPE     (0x3 <<  5) // (AIC) Interrupt Source Type
+#define 	AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE  (0x0 <<  5) // (AIC) Internal Sources Code Label Level Sensitive
+#define 	AT91C_AIC_SRCTYPE_INT_EDGE_TRIGGERED   (0x1 <<  5) // (AIC) Internal Sources Code Label Edge triggered
+#define 	AT91C_AIC_SRCTYPE_EXT_HIGH_LEVEL       (0x2 <<  5) // (AIC) External Sources Code Label High-level Sensitive
+#define 	AT91C_AIC_SRCTYPE_EXT_POSITIVE_EDGE    (0x3 <<  5) // (AIC) External Sources Code Label Positive Edge triggered
+// -------- AIC_CISR : (AIC Offset: 0x114) AIC Core Interrupt Status Register -------- 
+#define AT91C_AIC_NFIQ        (0x1 <<  0) // (AIC) NFIQ Status
+#define AT91C_AIC_NIRQ        (0x1 <<  1) // (AIC) NIRQ Status
+// -------- AIC_DCR : (AIC Offset: 0x138) AIC Debug Control Register (Protect) -------- 
+#define AT91C_AIC_DCR_PROT    (0x1 <<  0) // (AIC) Protection Mode
+#define AT91C_AIC_DCR_GMSK    (0x1 <<  1) // (AIC) General Mask
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Peripheral DMA Controller
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_PDC {
+	AT91_REG	 PDC_RPR; 	// Receive Pointer Register
+	AT91_REG	 PDC_RCR; 	// Receive Counter Register
+	AT91_REG	 PDC_TPR; 	// Transmit Pointer Register
+	AT91_REG	 PDC_TCR; 	// Transmit Counter Register
+	AT91_REG	 PDC_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 PDC_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 PDC_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 PDC_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 PDC_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 PDC_PTSR; 	// PDC Transfer Status Register
+} AT91S_PDC, *AT91PS_PDC;
+#else
+#define PDC_RPR         (AT91_CAST(AT91_REG *) 	0x00000000) // (PDC_RPR) Receive Pointer Register
+#define PDC_RCR         (AT91_CAST(AT91_REG *) 	0x00000004) // (PDC_RCR) Receive Counter Register
+#define PDC_TPR         (AT91_CAST(AT91_REG *) 	0x00000008) // (PDC_TPR) Transmit Pointer Register
+#define PDC_TCR         (AT91_CAST(AT91_REG *) 	0x0000000C) // (PDC_TCR) Transmit Counter Register
+#define PDC_RNPR        (AT91_CAST(AT91_REG *) 	0x00000010) // (PDC_RNPR) Receive Next Pointer Register
+#define PDC_RNCR        (AT91_CAST(AT91_REG *) 	0x00000014) // (PDC_RNCR) Receive Next Counter Register
+#define PDC_TNPR        (AT91_CAST(AT91_REG *) 	0x00000018) // (PDC_TNPR) Transmit Next Pointer Register
+#define PDC_TNCR        (AT91_CAST(AT91_REG *) 	0x0000001C) // (PDC_TNCR) Transmit Next Counter Register
+#define PDC_PTCR        (AT91_CAST(AT91_REG *) 	0x00000020) // (PDC_PTCR) PDC Transfer Control Register
+#define PDC_PTSR        (AT91_CAST(AT91_REG *) 	0x00000024) // (PDC_PTSR) PDC Transfer Status Register
+
+#endif
+// -------- PDC_PTCR : (PDC Offset: 0x20) PDC Transfer Control Register -------- 
+#define AT91C_PDC_RXTEN       (0x1 <<  0) // (PDC) Receiver Transfer Enable
+#define AT91C_PDC_RXTDIS      (0x1 <<  1) // (PDC) Receiver Transfer Disable
+#define AT91C_PDC_TXTEN       (0x1 <<  8) // (PDC) Transmitter Transfer Enable
+#define AT91C_PDC_TXTDIS      (0x1 <<  9) // (PDC) Transmitter Transfer Disable
+// -------- PDC_PTSR : (PDC Offset: 0x24) PDC Transfer Status Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Debug Unit
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_DBGU {
+	AT91_REG	 DBGU_CR; 	// Control Register
+	AT91_REG	 DBGU_MR; 	// Mode Register
+	AT91_REG	 DBGU_IER; 	// Interrupt Enable Register
+	AT91_REG	 DBGU_IDR; 	// Interrupt Disable Register
+	AT91_REG	 DBGU_IMR; 	// Interrupt Mask Register
+	AT91_REG	 DBGU_CSR; 	// Channel Status Register
+	AT91_REG	 DBGU_RHR; 	// Receiver Holding Register
+	AT91_REG	 DBGU_THR; 	// Transmitter Holding Register
+	AT91_REG	 DBGU_BRGR; 	// Baud Rate Generator Register
+	AT91_REG	 Reserved0[7]; 	// 
+	AT91_REG	 DBGU_CIDR; 	// Chip ID Register
+	AT91_REG	 DBGU_EXID; 	// Chip ID Extension Register
+	AT91_REG	 DBGU_FNTR; 	// Force NTRST Register
+	AT91_REG	 Reserved1[45]; 	// 
+	AT91_REG	 DBGU_RPR; 	// Receive Pointer Register
+	AT91_REG	 DBGU_RCR; 	// Receive Counter Register
+	AT91_REG	 DBGU_TPR; 	// Transmit Pointer Register
+	AT91_REG	 DBGU_TCR; 	// Transmit Counter Register
+	AT91_REG	 DBGU_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 DBGU_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 DBGU_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 DBGU_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 DBGU_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 DBGU_PTSR; 	// PDC Transfer Status Register
+} AT91S_DBGU, *AT91PS_DBGU;
+#else
+#define DBGU_CR         (AT91_CAST(AT91_REG *) 	0x00000000) // (DBGU_CR) Control Register
+#define DBGU_MR         (AT91_CAST(AT91_REG *) 	0x00000004) // (DBGU_MR) Mode Register
+#define DBGU_IER        (AT91_CAST(AT91_REG *) 	0x00000008) // (DBGU_IER) Interrupt Enable Register
+#define DBGU_IDR        (AT91_CAST(AT91_REG *) 	0x0000000C) // (DBGU_IDR) Interrupt Disable Register
+#define DBGU_IMR        (AT91_CAST(AT91_REG *) 	0x00000010) // (DBGU_IMR) Interrupt Mask Register
+#define DBGU_CSR        (AT91_CAST(AT91_REG *) 	0x00000014) // (DBGU_CSR) Channel Status Register
+#define DBGU_RHR        (AT91_CAST(AT91_REG *) 	0x00000018) // (DBGU_RHR) Receiver Holding Register
+#define DBGU_THR        (AT91_CAST(AT91_REG *) 	0x0000001C) // (DBGU_THR) Transmitter Holding Register
+#define DBGU_BRGR       (AT91_CAST(AT91_REG *) 	0x00000020) // (DBGU_BRGR) Baud Rate Generator Register
+#define DBGU_CIDR       (AT91_CAST(AT91_REG *) 	0x00000040) // (DBGU_CIDR) Chip ID Register
+#define DBGU_EXID       (AT91_CAST(AT91_REG *) 	0x00000044) // (DBGU_EXID) Chip ID Extension Register
+#define DBGU_FNTR       (AT91_CAST(AT91_REG *) 	0x00000048) // (DBGU_FNTR) Force NTRST Register
+
+#endif
+// -------- DBGU_CR : (DBGU Offset: 0x0) Debug Unit Control Register -------- 
+#define AT91C_DBGU_RSTRX      (0x1 <<  2) // (DBGU) Reset Receiver
+#define AT91C_DBGU_RSTTX      (0x1 <<  3) // (DBGU) Reset Transmitter
+#define AT91C_DBGU_RXEN       (0x1 <<  4) // (DBGU) Receiver Enable
+#define AT91C_DBGU_RXDIS      (0x1 <<  5) // (DBGU) Receiver Disable
+#define AT91C_DBGU_TXEN       (0x1 <<  6) // (DBGU) Transmitter Enable
+#define AT91C_DBGU_TXDIS      (0x1 <<  7) // (DBGU) Transmitter Disable
+#define AT91C_DBGU_RSTSTA     (0x1 <<  8) // (DBGU) Reset Status Bits
+// -------- DBGU_MR : (DBGU Offset: 0x4) Debug Unit Mode Register -------- 
+#define AT91C_DBGU_PAR        (0x7 <<  9) // (DBGU) Parity type
+#define 	AT91C_DBGU_PAR_EVEN                 (0x0 <<  9) // (DBGU) Even Parity
+#define 	AT91C_DBGU_PAR_ODD                  (0x1 <<  9) // (DBGU) Odd Parity
+#define 	AT91C_DBGU_PAR_SPACE                (0x2 <<  9) // (DBGU) Parity forced to 0 (Space)
+#define 	AT91C_DBGU_PAR_MARK                 (0x3 <<  9) // (DBGU) Parity forced to 1 (Mark)
+#define 	AT91C_DBGU_PAR_NONE                 (0x4 <<  9) // (DBGU) No Parity
+#define AT91C_DBGU_CHMODE     (0x3 << 14) // (DBGU) Channel Mode
+#define 	AT91C_DBGU_CHMODE_NORMAL               (0x0 << 14) // (DBGU) Normal Mode: The debug unit channel operates as an RX/TX debug unit.
+#define 	AT91C_DBGU_CHMODE_AUTO                 (0x1 << 14) // (DBGU) Automatic Echo: Receiver Data Input is connected to the TXD pin.
+#define 	AT91C_DBGU_CHMODE_LOCAL                (0x2 << 14) // (DBGU) Local Loopback: Transmitter Output Signal is connected to Receiver Input Signal.
+#define 	AT91C_DBGU_CHMODE_REMOTE               (0x3 << 14) // (DBGU) Remote Loopback: RXD pin is internally connected to TXD pin.
+// -------- DBGU_IER : (DBGU Offset: 0x8) Debug Unit Interrupt Enable Register -------- 
+#define AT91C_DBGU_RXRDY      (0x1 <<  0) // (DBGU) RXRDY Interrupt
+#define AT91C_DBGU_TXRDY      (0x1 <<  1) // (DBGU) TXRDY Interrupt
+#define AT91C_DBGU_ENDRX      (0x1 <<  3) // (DBGU) End of Receive Transfer Interrupt
+#define AT91C_DBGU_ENDTX      (0x1 <<  4) // (DBGU) End of Transmit Interrupt
+#define AT91C_DBGU_OVRE       (0x1 <<  5) // (DBGU) Overrun Interrupt
+#define AT91C_DBGU_FRAME      (0x1 <<  6) // (DBGU) Framing Error Interrupt
+#define AT91C_DBGU_PARE       (0x1 <<  7) // (DBGU) Parity Error Interrupt
+#define AT91C_DBGU_TXEMPTY    (0x1 <<  9) // (DBGU) TXEMPTY Interrupt
+#define AT91C_DBGU_TXBUFE     (0x1 << 11) // (DBGU) TXBUFE Interrupt
+#define AT91C_DBGU_RXBUFF     (0x1 << 12) // (DBGU) RXBUFF Interrupt
+#define AT91C_DBGU_COMM_TX    (0x1 << 30) // (DBGU) COMM_TX Interrupt
+#define AT91C_DBGU_COMM_RX    (0x1 << 31) // (DBGU) COMM_RX Interrupt
+// -------- DBGU_IDR : (DBGU Offset: 0xc) Debug Unit Interrupt Disable Register -------- 
+// -------- DBGU_IMR : (DBGU Offset: 0x10) Debug Unit Interrupt Mask Register -------- 
+// -------- DBGU_CSR : (DBGU Offset: 0x14) Debug Unit Channel Status Register -------- 
+// -------- DBGU_FNTR : (DBGU Offset: 0x48) Debug Unit FORCE_NTRST Register -------- 
+#define AT91C_DBGU_FORCE_NTRST (0x1 <<  0) // (DBGU) Force NTRST in JTAG
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Parallel Input Output Controler
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_PIO {
+	AT91_REG	 PIO_PER; 	// PIO Enable Register
+	AT91_REG	 PIO_PDR; 	// PIO Disable Register
+	AT91_REG	 PIO_PSR; 	// PIO Status Register
+	AT91_REG	 Reserved0[1]; 	// 
+	AT91_REG	 PIO_OER; 	// Output Enable Register
+	AT91_REG	 PIO_ODR; 	// Output Disable Registerr
+	AT91_REG	 PIO_OSR; 	// Output Status Register
+	AT91_REG	 Reserved1[1]; 	// 
+	AT91_REG	 PIO_IFER; 	// Input Filter Enable Register
+	AT91_REG	 PIO_IFDR; 	// Input Filter Disable Register
+	AT91_REG	 PIO_IFSR; 	// Input Filter Status Register
+	AT91_REG	 Reserved2[1]; 	// 
+	AT91_REG	 PIO_SODR; 	// Set Output Data Register
+	AT91_REG	 PIO_CODR; 	// Clear Output Data Register
+	AT91_REG	 PIO_ODSR; 	// Output Data Status Register
+	AT91_REG	 PIO_PDSR; 	// Pin Data Status Register
+	AT91_REG	 PIO_IER; 	// Interrupt Enable Register
+	AT91_REG	 PIO_IDR; 	// Interrupt Disable Register
+	AT91_REG	 PIO_IMR; 	// Interrupt Mask Register
+	AT91_REG	 PIO_ISR; 	// Interrupt Status Register
+	AT91_REG	 PIO_MDER; 	// Multi-driver Enable Register
+	AT91_REG	 PIO_MDDR; 	// Multi-driver Disable Register
+	AT91_REG	 PIO_MDSR; 	// Multi-driver Status Register
+	AT91_REG	 Reserved3[1]; 	// 
+	AT91_REG	 PIO_PPUDR; 	// Pull-up Disable Register
+	AT91_REG	 PIO_PPUER; 	// Pull-up Enable Register
+	AT91_REG	 PIO_PPUSR; 	// Pull-up Status Register
+	AT91_REG	 Reserved4[1]; 	// 
+	AT91_REG	 PIO_ASR; 	// Select A Register
+	AT91_REG	 PIO_BSR; 	// Select B Register
+	AT91_REG	 PIO_ABSR; 	// AB Select Status Register
+	AT91_REG	 Reserved5[9]; 	// 
+	AT91_REG	 PIO_OWER; 	// Output Write Enable Register
+	AT91_REG	 PIO_OWDR; 	// Output Write Disable Register
+	AT91_REG	 PIO_OWSR; 	// Output Write Status Register
+	AT91_REG	 Reserved6[1]; 	// 
+	AT91_REG	 PIO_SLEWRATE1; 	// PIO Slewrate Control Register
+	AT91_REG	 Reserved7[3]; 	// 
+	AT91_REG	 PIO_DELAY1; 	// PIO Delay Control Register
+	AT91_REG	 PIO_DELAY2; 	// PIO Delay Control Register
+	AT91_REG	 PIO_DELAY3; 	// PIO Delay Control Register
+	AT91_REG	 PIO_DELAY4; 	// PIO Delay Control Register
+	AT91_REG	 Reserved8[11]; 	// 
+	AT91_REG	 PIO_VERSION; 	// PIO Version Register
+} AT91S_PIO, *AT91PS_PIO;
+#else
+#define PIO_PER         (AT91_CAST(AT91_REG *) 	0x00000000) // (PIO_PER) PIO Enable Register
+#define PIO_PDR         (AT91_CAST(AT91_REG *) 	0x00000004) // (PIO_PDR) PIO Disable Register
+#define PIO_PSR         (AT91_CAST(AT91_REG *) 	0x00000008) // (PIO_PSR) PIO Status Register
+#define PIO_OER         (AT91_CAST(AT91_REG *) 	0x00000010) // (PIO_OER) Output Enable Register
+#define PIO_ODR         (AT91_CAST(AT91_REG *) 	0x00000014) // (PIO_ODR) Output Disable Registerr
+#define PIO_OSR         (AT91_CAST(AT91_REG *) 	0x00000018) // (PIO_OSR) Output Status Register
+#define PIO_IFER        (AT91_CAST(AT91_REG *) 	0x00000020) // (PIO_IFER) Input Filter Enable Register
+#define PIO_IFDR        (AT91_CAST(AT91_REG *) 	0x00000024) // (PIO_IFDR) Input Filter Disable Register
+#define PIO_IFSR        (AT91_CAST(AT91_REG *) 	0x00000028) // (PIO_IFSR) Input Filter Status Register
+#define PIO_SODR        (AT91_CAST(AT91_REG *) 	0x00000030) // (PIO_SODR) Set Output Data Register
+#define PIO_CODR        (AT91_CAST(AT91_REG *) 	0x00000034) // (PIO_CODR) Clear Output Data Register
+#define PIO_ODSR        (AT91_CAST(AT91_REG *) 	0x00000038) // (PIO_ODSR) Output Data Status Register
+#define PIO_PDSR        (AT91_CAST(AT91_REG *) 	0x0000003C) // (PIO_PDSR) Pin Data Status Register
+#define PIO_IER         (AT91_CAST(AT91_REG *) 	0x00000040) // (PIO_IER) Interrupt Enable Register
+#define PIO_IDR         (AT91_CAST(AT91_REG *) 	0x00000044) // (PIO_IDR) Interrupt Disable Register
+#define PIO_IMR         (AT91_CAST(AT91_REG *) 	0x00000048) // (PIO_IMR) Interrupt Mask Register
+#define PIO_ISR         (AT91_CAST(AT91_REG *) 	0x0000004C) // (PIO_ISR) Interrupt Status Register
+#define PIO_MDER        (AT91_CAST(AT91_REG *) 	0x00000050) // (PIO_MDER) Multi-driver Enable Register
+#define PIO_MDDR        (AT91_CAST(AT91_REG *) 	0x00000054) // (PIO_MDDR) Multi-driver Disable Register
+#define PIO_MDSR        (AT91_CAST(AT91_REG *) 	0x00000058) // (PIO_MDSR) Multi-driver Status Register
+#define PIO_PPUDR       (AT91_CAST(AT91_REG *) 	0x00000060) // (PIO_PPUDR) Pull-up Disable Register
+#define PIO_PPUER       (AT91_CAST(AT91_REG *) 	0x00000064) // (PIO_PPUER) Pull-up Enable Register
+#define PIO_PPUSR       (AT91_CAST(AT91_REG *) 	0x00000068) // (PIO_PPUSR) Pull-up Status Register
+#define PIO_ASR         (AT91_CAST(AT91_REG *) 	0x00000070) // (PIO_ASR) Select A Register
+#define PIO_BSR         (AT91_CAST(AT91_REG *) 	0x00000074) // (PIO_BSR) Select B Register
+#define PIO_ABSR        (AT91_CAST(AT91_REG *) 	0x00000078) // (PIO_ABSR) AB Select Status Register
+#define PIO_OWER        (AT91_CAST(AT91_REG *) 	0x000000A0) // (PIO_OWER) Output Write Enable Register
+#define PIO_OWDR        (AT91_CAST(AT91_REG *) 	0x000000A4) // (PIO_OWDR) Output Write Disable Register
+#define PIO_OWSR        (AT91_CAST(AT91_REG *) 	0x000000A8) // (PIO_OWSR) Output Write Status Register
+#define SLEWRATE1       (AT91_CAST(AT91_REG *) 	0x000000B0) // (SLEWRATE1) PIO Slewrate Control Register
+#define PIO_VERSION     (AT91_CAST(AT91_REG *) 	0x000000FC) // (PIO_VERSION) PIO Version Register
+
+#endif
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Power Management Controller V610
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_PMC {
+	AT91_REG	 PMC_SCER; 	// System Clock Enable Register
+	AT91_REG	 PMC_SCDR; 	// System Clock Disable Register
+	AT91_REG	 PMC_SCSR; 	// System Clock Status Register
+	AT91_REG	 Reserved0[1]; 	// 
+	AT91_REG	 PMC_PCER; 	// Peripheral Clock Enable Register
+	AT91_REG	 PMC_PCDR; 	// Peripheral Clock Disable Register
+	AT91_REG	 PMC_PCSR; 	// Peripheral Clock Status Register
+	AT91_REG	 PMC_UCKR; 	// UTMI Clock Configuration Register
+	AT91_REG	 PMC_MOR; 	// Main Oscillator Register
+	AT91_REG	 PMC_MCFR; 	// Main Clock  Frequency Register
+	AT91_REG	 PMC_PLLAR; 	// PLL A Register
+	AT91_REG	 Reserved1[1]; 	// 
+	AT91_REG	 PMC_MCKR; 	// Master Clock Register
+	AT91_REG	 Reserved2[1]; 	// 
+	AT91_REG	 PMC_USB; 	// USB clock register
+	AT91_REG	 Reserved3[1]; 	// 
+	AT91_REG	 PMC_PCKR[2]; 	// Programmable Clock 0 Register
+	AT91_REG	 Reserved4[6]; 	// 
+	AT91_REG	 PMC_IER; 	// Interrupt Enable Register
+	AT91_REG	 PMC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 PMC_SR; 	// Status Register
+	AT91_REG	 PMC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 Reserved5[4]; 	// 
+	AT91_REG	 PMC_PLLICPR; 	// PLL Charge Pump Current Register
+	AT91_REG	 Reserved6[26]; 	// 
+	AT91_REG	 PMC_ADDRSIZE; 	// 
+	AT91_REG	 PMC_NAME1; 	// 
+	AT91_REG	 PMC_NAME2; 	// 
+	AT91_REG	 PMC_FEATURES; 	// 
+	AT91_REG	 PMC_VERSION; 	// 
+} AT91S_PMC, *AT91PS_PMC;
+#else
+#define PMC_SCER        (AT91_CAST(AT91_REG *) 	0x00000000) // (PMC_SCER) System Clock Enable Register
+#define PMC_SCDR        (AT91_CAST(AT91_REG *) 	0x00000004) // (PMC_SCDR) System Clock Disable Register
+#define PMC_SCSR        (AT91_CAST(AT91_REG *) 	0x00000008) // (PMC_SCSR) System Clock Status Register
+#define PMC_PCER        (AT91_CAST(AT91_REG *) 	0x00000010) // (PMC_PCER) Peripheral Clock Enable Register
+#define PMC_PCDR        (AT91_CAST(AT91_REG *) 	0x00000014) // (PMC_PCDR) Peripheral Clock Disable Register
+#define PMC_PCSR        (AT91_CAST(AT91_REG *) 	0x00000018) // (PMC_PCSR) Peripheral Clock Status Register
+#define CKGR_UCKR       (AT91_CAST(AT91_REG *) 	0x0000001C) // (CKGR_UCKR) UTMI Clock Configuration Register
+#define CKGR_MOR        (AT91_CAST(AT91_REG *) 	0x00000020) // (CKGR_MOR) Main Oscillator Register
+#define CKGR_MCFR       (AT91_CAST(AT91_REG *) 	0x00000024) // (CKGR_MCFR) Main Clock  Frequency Register
+#define CKGR_PLLAR      (AT91_CAST(AT91_REG *) 	0x00000028) // (CKGR_PLLAR) PLL A Register
+#define PMC_MCKR        (AT91_CAST(AT91_REG *) 	0x00000030) // (PMC_MCKR) Master Clock Register
+#define PMC_USB         (AT91_CAST(AT91_REG *) 	0x00000038) // (PMC_USB) USB clock register
+#define PMC_PCKR        (AT91_CAST(AT91_REG *) 	0x00000040) // (PMC_PCKR) Programmable Clock 0 Register
+#define PMC_IER         (AT91_CAST(AT91_REG *) 	0x00000060) // (PMC_IER) Interrupt Enable Register
+#define PMC_IDR         (AT91_CAST(AT91_REG *) 	0x00000064) // (PMC_IDR) Interrupt Disable Register
+#define PMC_SR          (AT91_CAST(AT91_REG *) 	0x00000068) // (PMC_SR) Status Register
+#define PMC_IMR         (AT91_CAST(AT91_REG *) 	0x0000006C) // (PMC_IMR) Interrupt Mask Register
+#define PMC_PLLICPR     (AT91_CAST(AT91_REG *) 	0x00000080) // (PMC_PLLICPR) PLL Charge Pump Current Register
+#define PMC_ADDRSIZE    (AT91_CAST(AT91_REG *) 	0x000000EC) // (PMC_ADDRSIZE) 
+#define PMC_NAME1       (AT91_CAST(AT91_REG *) 	0x000000F0) // (PMC_NAME1) 
+#define PMC_NAME2       (AT91_CAST(AT91_REG *) 	0x000000F4) // (PMC_NAME2) 
+#define PMC_FEATURES    (AT91_CAST(AT91_REG *) 	0x000000F8) // (PMC_FEATURES) 
+#define PMC_VERSION     (AT91_CAST(AT91_REG *) 	0x000000FC) // (PMC_VERSION) 
+
+#endif
+// -------- PMC_SCER : (PMC Offset: 0x0) System Clock Enable Register -------- 
+#define AT91C_PMC_DDR         (0x1 <<  2) // (PMC) DDR controller Clock2x
+#define AT91C_PMC_UHP         (0x1 <<  6) // (PMC) USB Host Port Clock
+#define AT91C_PMC_UDP         (0x1 <<  7) // (PMC) USB Device Port Clock
+#define AT91C_PMC_PCK0        (0x1 <<  8) // (PMC) Programmable Clock Output
+#define AT91C_PMC_PCK1        (0x1 <<  9) // (PMC) Programmable Clock Output
+// -------- PMC_SCDR : (PMC Offset: 0x4) System Clock Disable Register -------- 
+#define AT91C_PMC_PCK         (0x1 <<  0) // (PMC) Processor Clock
+// -------- PMC_SCSR : (PMC Offset: 0x8) System Clock Status Register -------- 
+// -------- CKGR_UCKR : (PMC Offset: 0x1c) UTMI Clock Configuration Register -------- 
+#define AT91C_CKGR_UPLLEN     (0x1 << 16) // (PMC) UTMI PLL Enable
+#define 	AT91C_CKGR_UPLLEN_DISABLED             (0x0 << 16) // (PMC) The UTMI PLL is disabled
+#define 	AT91C_CKGR_UPLLEN_ENABLED              (0x1 << 16) // (PMC) The UTMI PLL is enabled
+#define AT91C_CKGR_PLLCOUNT   (0xF << 20) // (PMC) UTMI Oscillator Start-up Time
+#define AT91C_CKGR_BIASEN     (0x1 << 24) // (PMC) UTMI BIAS Enable
+#define 	AT91C_CKGR_BIASEN_DISABLED             (0x0 << 24) // (PMC) The UTMI BIAS is disabled
+#define 	AT91C_CKGR_BIASEN_ENABLED              (0x1 << 24) // (PMC) The UTMI BIAS is enabled
+#define AT91C_CKGR_BIASCOUNT  (0xF << 28) // (PMC) UTMI BIAS Start-up Time
+// -------- CKGR_MOR : (PMC Offset: 0x20) Main Oscillator Register -------- 
+#define AT91C_CKGR_MOSCEN     (0x1 <<  0) // (PMC) Main Oscillator Enable
+#define AT91C_CKGR_OSCBYPASS  (0x1 <<  1) // (PMC) Main Oscillator Bypass
+#define AT91C_CKGR_OSCOUNT    (0xFF <<  8) // (PMC) Main Oscillator Start-up Time
+// -------- CKGR_MCFR : (PMC Offset: 0x24) Main Clock Frequency Register -------- 
+#define AT91C_CKGR_MAINF      (0xFFFF <<  0) // (PMC) Main Clock Frequency
+#define AT91C_CKGR_MAINRDY    (0x1 << 16) // (PMC) Main Clock Ready
+// -------- CKGR_PLLAR : (PMC Offset: 0x28) PLL A Register -------- 
+#define AT91C_CKGR_DIVA       (0xFF <<  0) // (PMC) Divider A Selected
+#define 	AT91C_CKGR_DIVA_0                    (0x0) // (PMC) Divider A output is 0
+#define 	AT91C_CKGR_DIVA_BYPASS               (0x1) // (PMC) Divider A is bypassed
+#define AT91C_CKGR_PLLACOUNT  (0x3F <<  8) // (PMC) PLL A Counter
+#define AT91C_CKGR_OUTA       (0x3 << 14) // (PMC) PLL A Output Frequency Range
+#define 	AT91C_CKGR_OUTA_0                    (0x0 << 14) // (PMC) Please refer to the PLLA datasheet
+#define 	AT91C_CKGR_OUTA_1                    (0x1 << 14) // (PMC) Please refer to the PLLA datasheet
+#define 	AT91C_CKGR_OUTA_2                    (0x2 << 14) // (PMC) Please refer to the PLLA datasheet
+#define 	AT91C_CKGR_OUTA_3                    (0x3 << 14) // (PMC) Please refer to the PLLA datasheet
+#define AT91C_CKGR_MULA       (0xFF << 16) // (PMC) PLL A Multiplier
+#define AT91C_CKGR_SRCA       (0x1 << 29) // (PMC) 
+// -------- PMC_MCKR : (PMC Offset: 0x30) Master Clock Register -------- 
+#define AT91C_PMC_CSS         (0x3 <<  0) // (PMC) Programmable Clock Selection
+#define 	AT91C_PMC_CSS_SLOW_CLK             (0x0) // (PMC) Slow Clock is selected
+#define 	AT91C_PMC_CSS_MAIN_CLK             (0x1) // (PMC) Main Clock is selected
+#define 	AT91C_PMC_CSS_PLLA_CLK             (0x2) // (PMC) Clock from PLL A is selected
+#define 	AT91C_PMC_CSS_UPLL_CLK             (0x3) // (PMC) Clock from UTMI PLL is selected
+#define AT91C_PMC_PRES        (0x7 <<  2) // (PMC) Programmable Clock Prescaler
+#define 	AT91C_PMC_PRES_CLK                  (0x0 <<  2) // (PMC) Selected clock
+#define 	AT91C_PMC_PRES_CLK_2                (0x1 <<  2) // (PMC) Selected clock divided by 2
+#define 	AT91C_PMC_PRES_CLK_4                (0x2 <<  2) // (PMC) Selected clock divided by 4
+#define 	AT91C_PMC_PRES_CLK_8                (0x3 <<  2) // (PMC) Selected clock divided by 8
+#define 	AT91C_PMC_PRES_CLK_16               (0x4 <<  2) // (PMC) Selected clock divided by 16
+#define 	AT91C_PMC_PRES_CLK_32               (0x5 <<  2) // (PMC) Selected clock divided by 32
+#define 	AT91C_PMC_PRES_CLK_64               (0x6 <<  2) // (PMC) Selected clock divided by 64
+#define AT91C_PMC_MDIV        (0x3 <<  8) // (PMC) Master Clock Division
+#define 	AT91C_PMC_MDIV_1                    (0x0 <<  8) // (PMC) Processor clock = Master Clock ; DDR Clock = Master Clock
+#define 	AT91C_PMC_MDIV_2                    (0x1 <<  8) // (PMC) Processor clock = 2 * Master Clock ; DDR Clock = 2 * Master Clock
+#define 	AT91C_PMC_MDIV_4                    (0x2 <<  8) // (PMC) Processor clock = 4 * Master Clock ; DDR Clock = 2 * Master Clock
+#define 	AT91C_PMC_MDIV_3                    (0x3 <<  8) // (PMC) Processor clock = 3 * Master Clock ; DDR Clock = 2 * Master Clock
+#define AT91C_PMC_PLLADIV2    (0x1 << 12) // (PMC) PLLA divisor by 2
+#define 	AT91C_PMC_PLLADIV2_1                    (0x0 << 12) // (PMC) PLLA clock frequency is divided by 1
+#define 	AT91C_PMC_PLLADIV2_2                    (0x1 << 12) // (PMC) PLLA clock frequency is divided by 2
+// -------- PMC_USB : (PMC Offset: 0x38) USB Clock Register -------- 
+#define AT91C_PMC_USBS        (0x1 <<  0) // (PMC) USBS
+#define 	AT91C_PMC_USBS_USB_PLLA             (0x0) // (PMC) USB Clock Input is PLLA
+#define 	AT91C_PMC_USBS_USB_UPLL             (0x1) // (PMC) USB Clock Input is UPLL
+#define AT91C_PMC_USBDIV      (0xF <<  8) // (PMC) USBDIV
+#define 	AT91C_PMC_USBDIV_1                    (0x0 <<  8) // (PMC) USB Clock divided by 1
+#define 	AT91C_PMC_USBDIV_2                    (0x1 <<  8) // (PMC) USB Clock divided by 2
+#define 	AT91C_PMC_USBDIV_3                    (0x2 <<  8) // (PMC) USB Clock divided by 3
+#define 	AT91C_PMC_USBDIV_4                    (0x3 <<  8) // (PMC) USB Clock divided by 4
+#define 	AT91C_PMC_USBDIV_5                    (0x4 <<  8) // (PMC) USB Clock divided by 5
+#define 	AT91C_PMC_USBDIV_6                    (0x5 <<  8) // (PMC) USB Clock divided by 6
+#define 	AT91C_PMC_USBDIV_7                    (0x6 <<  8) // (PMC) USB Clock divided by 7
+#define 	AT91C_PMC_USBDIV_8                    (0x7 <<  8) // (PMC) USB Clock divided by 8
+#define 	AT91C_PMC_USBDIV_9                    (0x8 <<  8) // (PMC) USB Clock divided by 9
+#define 	AT91C_PMC_USBDIV_10                   (0x9 <<  8) // (PMC) USB Clock divided by 10
+#define 	AT91C_PMC_USBDIV_11                   (0xA <<  8) // (PMC) USB Clock divided by 11
+#define 	AT91C_PMC_USBDIV_12                   (0xB <<  8) // (PMC) USB Clock divided by 12
+#define 	AT91C_PMC_USBDIV_13                   (0xC <<  8) // (PMC) USB Clock divided by 13
+#define 	AT91C_PMC_USBDIV_14                   (0xD <<  8) // (PMC) USB Clock divided by 14
+#define 	AT91C_PMC_USBDIV_15                   (0xE <<  8) // (PMC) USB Clock divided by 15
+#define 	AT91C_PMC_USBDIV_16                   (0xF <<  8) // (PMC) USB Clock divided by 16
+// -------- PMC_PCKR : (PMC Offset: 0x40) Programmable Clock 0 Register -------- 
+#define AT91C_PMC_SLCKMCK     (0x1 <<  8) // (PMC) Programmable Clock Prescaler
+#define 	AT91C_PMC_SLCKMCK_SLCK                 (0x0 <<  8) // (PMC) Slow Clock selected
+#define 	AT91C_PMC_SLCKMCK_MCK                  (0x1 <<  8) // (PMC) Master Clock selected
+// -------- PMC_IER : (PMC Offset: 0x60) PMC Interrupt Enable Register -------- 
+#define AT91C_PMC_MOSCS       (0x1 <<  0) // (PMC) MOSC Status/Enable/Disable/Mask
+#define AT91C_PMC_LOCKA       (0x1 <<  1) // (PMC) PLL A Status/Enable/Disable/Mask
+#define AT91C_PMC_MCKRDY      (0x1 <<  3) // (PMC) Master Clock Status/Enable/Disable/Mask
+#define AT91C_PMC_LOCKU       (0x1 <<  6) // (PMC) PLL UTMI Status/Enable/Disable/Mask
+#define AT91C_PMC_PCK0RDY     (0x1 <<  8) // (PMC) PCK0_RDY Status/Enable/Disable/Mask
+#define AT91C_PMC_PCK1RDY     (0x1 <<  9) // (PMC) PCK1_RDY Status/Enable/Disable/Mask
+// -------- PMC_IDR : (PMC Offset: 0x64) PMC Interrupt Disable Register -------- 
+// -------- PMC_SR : (PMC Offset: 0x68) PMC Status Register -------- 
+// -------- PMC_IMR : (PMC Offset: 0x6c) PMC Interrupt Mask Register -------- 
+// -------- PMC_PLLICPR : (PMC Offset: 0x80) PLL Charge Pump Current Register -------- 
+#define AT91C_PMC_ICPPLLA     (0xF <<  0) // (PMC) PLLA charge pump current setting
+#define 	AT91C_PMC_ICPPLLA_0                    (0x0) // (PMC) 595-800 MHz
+#define 	AT91C_PMC_ICPPLLA_1                    (0x1) // (PMC) 395-600 MHz
+#define AT91C_PMC_REALLOCK    (0x1 <<  7) // (PMC) PLLs use real lock signals when 1
+#define AT91C_PMC_IPLLA       (0xF <<  8) // (PMC) PLLA special setting
+#define 	AT91C_PMC_IPLLA_0                    (0x0 <<  8) // (PMC) Internal LFT
+#define 	AT91C_PMC_IPLLA_1                    (0x1 <<  8) // (PMC) External LFT
+// -------- PMC_FEATURES : (PMC Offset: 0xf8)   -------- 
+#define AT91C_PMC_CFGAHBCLK   (0x1 <<  0) // (PMC) 
+#define 	AT91C_PMC_CFGAHBCLK_0                    (0x0) // (PMC) 
+#define 	AT91C_PMC_CFGAHBCLK_1                    (0x1) // (PMC) 
+#define AT91C_PMC_HCLKEN      (0x1 <<  1) // (PMC) 
+#define 	AT91C_PMC_HCLKEN_0                    (0x0 <<  1) // (PMC) 
+#define 	AT91C_PMC_HCLKEN_1                    (0x1 <<  1) // (PMC) 
+#define AT91C_PMC_PERMCLK     (0x1 <<  2) // (PMC) 
+#define 	AT91C_PMC_PERMCLK_0                    (0x0 <<  2) // (PMC) 
+#define 	AT91C_PMC_PERMCLK_1                    (0x1 <<  2) // (PMC) 
+#define AT91C_PMC_CORE2       (0x1 <<  3) // (PMC) 
+#define 	AT91C_PMC_CORE2_0                    (0x0 <<  3) // (PMC) 
+#define 	AT91C_PMC_CORE2_1                    (0x1 <<  3) // (PMC) 
+#define AT91C_PMC_USBDEVCK    (0x1 <<  4) // (PMC) 
+#define 	AT91C_PMC_USBDEVCK_0                    (0x0 <<  4) // (PMC) 
+#define 	AT91C_PMC_USBDEVCK_1                    (0x1 <<  4) // (PMC) 
+#define AT91C_PMC_USBHOSTCK   (0x1 <<  5) // (PMC) 
+#define 	AT91C_PMC_USBHOSTCK_0                    (0x0 <<  5) // (PMC) 
+#define 	AT91C_PMC_USBHOSTCK_1                    (0x1 <<  5) // (PMC) 
+#define AT91C_PMC_USBOTGCK    (0x1 <<  6) // (PMC) 
+#define 	AT91C_PMC_USBOTGCK_0                    (0x0 <<  6) // (PMC) 
+#define 	AT91C_PMC_USBOTGCK_1                    (0x1 <<  6) // (PMC) 
+#define AT91C_PMC_UHSYNRST    (0x1 <<  7) // (PMC) 
+#define 	AT91C_PMC_UHSYNRST_0                    (0x0 <<  7) // (PMC) 
+#define 	AT91C_PMC_UHSYNRST_1                    (0x1 <<  7) // (PMC) 
+#define AT91C_PMC_UOSYNRST    (0x1 <<  8) // (PMC) 
+#define 	AT91C_PMC_UOSYNRST_0                    (0x0 <<  8) // (PMC) 
+#define 	AT91C_PMC_UOSYNRST_1                    (0x1 <<  8) // (PMC) 
+#define AT91C_PMC_PLLENPOL    (0x1 <<  9) // (PMC) 
+#define 	AT91C_PMC_PLLENPOL_0                    (0x0 <<  9) // (PMC) 
+#define 	AT91C_PMC_PLLENPOL_1                    (0x1 <<  9) // (PMC) 
+#define AT91C_PMC_BIASREG     (0x1 << 10) // (PMC) 
+#define 	AT91C_PMC_BIASREG_0                    (0x0 << 10) // (PMC) 
+#define 	AT91C_PMC_BIASREG_1                    (0x1 << 10) // (PMC) 
+#define AT91C_PMC_OUTPLL      (0x1 << 11) // (PMC) 
+#define 	AT91C_PMC_OUTPLL_0                    (0x0 << 11) // (PMC) 
+#define 	AT91C_PMC_OUTPLL_1                    (0x1 << 11) // (PMC) 
+#define AT91C_PMC_OUTCURR     (0x1 << 12) // (PMC) 
+#define 	AT91C_PMC_OUTCURR_0                    (0x0 << 12) // (PMC) 
+#define 	AT91C_PMC_OUTCURR_1                    (0x1 << 12) // (PMC) 
+#define AT91C_PMC_FWUP        (0x1 << 13) // (PMC) 
+#define 	AT91C_PMC_FWUP_0                    (0x0 << 13) // (PMC) 
+#define 	AT91C_PMC_FWUP_1                    (0x1 << 13) // (PMC) 
+#define AT91C_PMC_SELMAINCLK  (0x1 << 14) // (PMC) 
+#define 	AT91C_PMC_SELMAINCLK_0                    (0x0 << 14) // (PMC) 
+#define 	AT91C_PMC_SELMAINCLK_1                    (0x1 << 14) // (PMC) 
+#define AT91C_PMC_RSTCLKM     (0x1 << 15) // (PMC) 
+#define 	AT91C_PMC_RSTCLKM_0                    (0x0 << 15) // (PMC) 
+#define 	AT91C_PMC_RSTCLKM_1                    (0x1 << 15) // (PMC) 
+#define AT91C_PMC_NB_PERIPH_CLOCK (0xFF << 16) // (PMC) 
+// -------- PMC_VERSION : (PMC Offset: 0xfc)   -------- 
+#define AT91C_PMC_Version     (0xFFFF <<  0) // (PMC) 
+#define 	AT91C_PMC_Version_0                    (0x0) // (PMC) 
+#define 	AT91C_PMC_Version_1                    (0x1) // (PMC) 
+#define AT91C_PMC_MFN         (0x7 << 16) // (PMC) 
+#define 	AT91C_PMC_MFN_0                    (0x0 << 16) // (PMC) 
+#define 	AT91C_PMC_MFN_1                    (0x1 << 16) // (PMC) 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Clock Generator Controler
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_CKGR {
+	AT91_REG	 CKGR_UCKR; 	// UTMI Clock Configuration Register
+	AT91_REG	 CKGR_MOR; 	// Main Oscillator Register
+	AT91_REG	 CKGR_MCFR; 	// Main Clock  Frequency Register
+	AT91_REG	 CKGR_PLLAR; 	// PLL A Register
+} AT91S_CKGR, *AT91PS_CKGR;
+#else
+
+#endif
+// -------- CKGR_UCKR : (CKGR Offset: 0x0) UTMI Clock Configuration Register -------- 
+// -------- CKGR_MOR : (CKGR Offset: 0x4) Main Oscillator Register -------- 
+// -------- CKGR_MCFR : (CKGR Offset: 0x8) Main Clock Frequency Register -------- 
+// -------- CKGR_PLLAR : (CKGR Offset: 0xc) PLL A Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Reset Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_RSTC {
+	AT91_REG	 RSTC_RCR; 	// Reset Control Register
+	AT91_REG	 RSTC_RSR; 	// Reset Status Register
+	AT91_REG	 RSTC_RMR; 	// Reset Mode Register
+	AT91_REG	 Reserved0[60]; 	// 
+	AT91_REG	 RSTC_VER; 	// Version Register
+} AT91S_RSTC, *AT91PS_RSTC;
+#else
+#define RSTC_RCR        (AT91_CAST(AT91_REG *) 	0x00000000) // (RSTC_RCR) Reset Control Register
+#define RSTC_RSR        (AT91_CAST(AT91_REG *) 	0x00000004) // (RSTC_RSR) Reset Status Register
+#define RSTC_RMR        (AT91_CAST(AT91_REG *) 	0x00000008) // (RSTC_RMR) Reset Mode Register
+#define RSTC_VER        (AT91_CAST(AT91_REG *) 	0x000000FC) // (RSTC_VER) Version Register
+
+#endif
+// -------- RSTC_RCR : (RSTC Offset: 0x0) Reset Control Register -------- 
+#define AT91C_RSTC_PROCRST    (0x1 <<  0) // (RSTC) Processor Reset
+#define AT91C_RSTC_ICERST     (0x1 <<  1) // (RSTC) ICE Interface Reset
+#define AT91C_RSTC_PERRST     (0x1 <<  2) // (RSTC) Peripheral Reset
+#define AT91C_RSTC_EXTRST     (0x1 <<  3) // (RSTC) External Reset
+#define AT91C_RSTC_KEY        (0xFF << 24) // (RSTC) Password
+// -------- RSTC_RSR : (RSTC Offset: 0x4) Reset Status Register -------- 
+#define AT91C_RSTC_URSTS      (0x1 <<  0) // (RSTC) User Reset Status
+#define AT91C_RSTC_RSTTYP     (0x7 <<  8) // (RSTC) Reset Type
+#define 	AT91C_RSTC_RSTTYP_GENERAL              (0x0 <<  8) // (RSTC) General reset. Both VDDCORE and VDDBU rising.
+#define 	AT91C_RSTC_RSTTYP_WAKEUP               (0x1 <<  8) // (RSTC) WakeUp Reset. VDDCORE rising.
+#define 	AT91C_RSTC_RSTTYP_WATCHDOG             (0x2 <<  8) // (RSTC) Watchdog Reset. Watchdog overflow occured.
+#define 	AT91C_RSTC_RSTTYP_SOFTWARE             (0x3 <<  8) // (RSTC) Software Reset. Processor reset required by the software.
+#define 	AT91C_RSTC_RSTTYP_USER                 (0x4 <<  8) // (RSTC) User Reset. NRST pin detected low.
+#define AT91C_RSTC_NRSTL      (0x1 << 16) // (RSTC) NRST pin level
+#define AT91C_RSTC_SRCMP      (0x1 << 17) // (RSTC) Software Reset Command in Progress.
+// -------- RSTC_RMR : (RSTC Offset: 0x8) Reset Mode Register -------- 
+#define AT91C_RSTC_URSTEN     (0x1 <<  0) // (RSTC) User Reset Enable
+#define AT91C_RSTC_URSTIEN    (0x1 <<  4) // (RSTC) User Reset Interrupt Enable
+#define AT91C_RSTC_ERSTL      (0xF <<  8) // (RSTC) User Reset Enable
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Shut Down Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_SHDWC {
+	AT91_REG	 SHDWC_SHCR; 	// Shut Down Control Register
+	AT91_REG	 SHDWC_SHMR; 	// Shut Down Mode Register
+	AT91_REG	 SHDWC_SHSR; 	// Shut Down Status Register
+} AT91S_SHDWC, *AT91PS_SHDWC;
+#else
+#define SHDWC_SHCR      (AT91_CAST(AT91_REG *) 	0x00000000) // (SHDWC_SHCR) Shut Down Control Register
+#define SHDWC_SHMR      (AT91_CAST(AT91_REG *) 	0x00000004) // (SHDWC_SHMR) Shut Down Mode Register
+#define SHDWC_SHSR      (AT91_CAST(AT91_REG *) 	0x00000008) // (SHDWC_SHSR) Shut Down Status Register
+
+#endif
+// -------- SHDWC_SHCR : (SHDWC Offset: 0x0) Shut Down Control Register -------- 
+#define AT91C_SHDWC_SHDW      (0x1 <<  0) // (SHDWC) Processor Reset
+#define AT91C_SHDWC_KEY       (0xFF << 24) // (SHDWC) Shut down KEY Password
+// -------- SHDWC_SHMR : (SHDWC Offset: 0x4) Shut Down Mode Register -------- 
+#define AT91C_SHDWC_WKMODE0   (0x3 <<  0) // (SHDWC) Wake Up 0 Mode Selection
+#define 	AT91C_SHDWC_WKMODE0_NONE                 (0x0) // (SHDWC) None. No detection is performed on the wake up input.
+#define 	AT91C_SHDWC_WKMODE0_HIGH                 (0x1) // (SHDWC) High Level.
+#define 	AT91C_SHDWC_WKMODE0_LOW                  (0x2) // (SHDWC) Low Level.
+#define 	AT91C_SHDWC_WKMODE0_ANYLEVEL             (0x3) // (SHDWC) Any level change.
+#define AT91C_SHDWC_CPTWK0    (0xF <<  4) // (SHDWC) Counter On Wake Up 0
+#define AT91C_SHDWC_WKMODE1   (0x3 <<  8) // (SHDWC) Wake Up 1 Mode Selection
+#define 	AT91C_SHDWC_WKMODE1_NONE                 (0x0 <<  8) // (SHDWC) None. No detection is performed on the wake up input.
+#define 	AT91C_SHDWC_WKMODE1_HIGH                 (0x1 <<  8) // (SHDWC) High Level.
+#define 	AT91C_SHDWC_WKMODE1_LOW                  (0x2 <<  8) // (SHDWC) Low Level.
+#define 	AT91C_SHDWC_WKMODE1_ANYLEVEL             (0x3 <<  8) // (SHDWC) Any level change.
+#define AT91C_SHDWC_CPTWK1    (0xF << 12) // (SHDWC) Counter On Wake Up 1
+#define AT91C_SHDWC_RTTWKEN   (0x1 << 16) // (SHDWC) Real Time Timer Wake Up Enable
+#define AT91C_SHDWC_RTCWKEN   (0x1 << 17) // (SHDWC) Real Time Clock Wake Up Enable
+// -------- SHDWC_SHSR : (SHDWC Offset: 0x8) Shut Down Status Register -------- 
+#define AT91C_SHDWC_WAKEUP0   (0x1 <<  0) // (SHDWC) Wake Up 0 Status
+#define AT91C_SHDWC_WAKEUP1   (0x1 <<  1) // (SHDWC) Wake Up 1 Status
+#define AT91C_SHDWC_FWKUP     (0x1 <<  2) // (SHDWC) Force Wake Up Status
+#define AT91C_SHDWC_RTTWK     (0x1 << 16) // (SHDWC) Real Time Timer wake Up
+#define AT91C_SHDWC_RTCWK     (0x1 << 17) // (SHDWC) Real Time Clock wake Up
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Real Time Timer Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_RTTC {
+	AT91_REG	 RTTC_RTMR; 	// Real-time Mode Register
+	AT91_REG	 RTTC_RTAR; 	// Real-time Alarm Register
+	AT91_REG	 RTTC_RTVR; 	// Real-time Value Register
+	AT91_REG	 RTTC_RTSR; 	// Real-time Status Register
+} AT91S_RTTC, *AT91PS_RTTC;
+#else
+#define RTTC_RTMR       (AT91_CAST(AT91_REG *) 	0x00000000) // (RTTC_RTMR) Real-time Mode Register
+#define RTTC_RTAR       (AT91_CAST(AT91_REG *) 	0x00000004) // (RTTC_RTAR) Real-time Alarm Register
+#define RTTC_RTVR       (AT91_CAST(AT91_REG *) 	0x00000008) // (RTTC_RTVR) Real-time Value Register
+#define RTTC_RTSR       (AT91_CAST(AT91_REG *) 	0x0000000C) // (RTTC_RTSR) Real-time Status Register
+
+#endif
+// -------- RTTC_RTMR : (RTTC Offset: 0x0) Real-time Mode Register -------- 
+#define AT91C_RTTC_RTPRES     (0xFFFF <<  0) // (RTTC) Real-time Timer Prescaler Value
+#define AT91C_RTTC_ALMIEN     (0x1 << 16) // (RTTC) Alarm Interrupt Enable
+#define AT91C_RTTC_RTTINCIEN  (0x1 << 17) // (RTTC) Real Time Timer Increment Interrupt Enable
+#define AT91C_RTTC_RTTRST     (0x1 << 18) // (RTTC) Real Time Timer Restart
+// -------- RTTC_RTAR : (RTTC Offset: 0x4) Real-time Alarm Register -------- 
+#define AT91C_RTTC_ALMV       (0x0 <<  0) // (RTTC) Alarm Value
+// -------- RTTC_RTVR : (RTTC Offset: 0x8) Current Real-time Value Register -------- 
+#define AT91C_RTTC_CRTV       (0x0 <<  0) // (RTTC) Current Real-time Value
+// -------- RTTC_RTSR : (RTTC Offset: 0xc) Real-time Status Register -------- 
+#define AT91C_RTTC_ALMS       (0x1 <<  0) // (RTTC) Real-time Alarm Status
+#define AT91C_RTTC_RTTINC     (0x1 <<  1) // (RTTC) Real-time Timer Increment
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Periodic Interval Timer Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_PITC {
+	AT91_REG	 PITC_PIMR; 	// Period Interval Mode Register
+	AT91_REG	 PITC_PISR; 	// Period Interval Status Register
+	AT91_REG	 PITC_PIVR; 	// Period Interval Value Register
+	AT91_REG	 PITC_PIIR; 	// Period Interval Image Register
+} AT91S_PITC, *AT91PS_PITC;
+#else
+#define PITC_PIMR       (AT91_CAST(AT91_REG *) 	0x00000000) // (PITC_PIMR) Period Interval Mode Register
+#define PITC_PISR       (AT91_CAST(AT91_REG *) 	0x00000004) // (PITC_PISR) Period Interval Status Register
+#define PITC_PIVR       (AT91_CAST(AT91_REG *) 	0x00000008) // (PITC_PIVR) Period Interval Value Register
+#define PITC_PIIR       (AT91_CAST(AT91_REG *) 	0x0000000C) // (PITC_PIIR) Period Interval Image Register
+
+#endif
+// -------- PITC_PIMR : (PITC Offset: 0x0) Periodic Interval Mode Register -------- 
+#define AT91C_PITC_PIV        (0xFFFFF <<  0) // (PITC) Periodic Interval Value
+#define AT91C_PITC_PITEN      (0x1 << 24) // (PITC) Periodic Interval Timer Enabled
+#define AT91C_PITC_PITIEN     (0x1 << 25) // (PITC) Periodic Interval Timer Interrupt Enable
+// -------- PITC_PISR : (PITC Offset: 0x4) Periodic Interval Status Register -------- 
+#define AT91C_PITC_PITS       (0x1 <<  0) // (PITC) Periodic Interval Timer Status
+// -------- PITC_PIVR : (PITC Offset: 0x8) Periodic Interval Value Register -------- 
+#define AT91C_PITC_CPIV       (0xFFFFF <<  0) // (PITC) Current Periodic Interval Value
+#define AT91C_PITC_PICNT      (0xFFF << 20) // (PITC) Periodic Interval Counter
+// -------- PITC_PIIR : (PITC Offset: 0xc) Periodic Interval Image Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Watchdog Timer Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_WDTC {
+	AT91_REG	 WDTC_WDCR; 	// Watchdog Control Register
+	AT91_REG	 WDTC_WDMR; 	// Watchdog Mode Register
+	AT91_REG	 WDTC_WDSR; 	// Watchdog Status Register
+} AT91S_WDTC, *AT91PS_WDTC;
+#else
+#define WDTC_WDCR       (AT91_CAST(AT91_REG *) 	0x00000000) // (WDTC_WDCR) Watchdog Control Register
+#define WDTC_WDMR       (AT91_CAST(AT91_REG *) 	0x00000004) // (WDTC_WDMR) Watchdog Mode Register
+#define WDTC_WDSR       (AT91_CAST(AT91_REG *) 	0x00000008) // (WDTC_WDSR) Watchdog Status Register
+
+#endif
+// -------- WDTC_WDCR : (WDTC Offset: 0x0) Periodic Interval Image Register -------- 
+#define AT91C_WDTC_WDRSTT     (0x1 <<  0) // (WDTC) Watchdog Restart
+#define AT91C_WDTC_KEY        (0xFF << 24) // (WDTC) Watchdog KEY Password
+// -------- WDTC_WDMR : (WDTC Offset: 0x4) Watchdog Mode Register -------- 
+#define AT91C_WDTC_WDV        (0xFFF <<  0) // (WDTC) Watchdog Timer Restart
+#define AT91C_WDTC_WDFIEN     (0x1 << 12) // (WDTC) Watchdog Fault Interrupt Enable
+#define AT91C_WDTC_WDRSTEN    (0x1 << 13) // (WDTC) Watchdog Reset Enable
+#define AT91C_WDTC_WDRPROC    (0x1 << 14) // (WDTC) Watchdog Timer Restart
+#define AT91C_WDTC_WDDIS      (0x1 << 15) // (WDTC) Watchdog Disable
+#define AT91C_WDTC_WDD        (0xFFF << 16) // (WDTC) Watchdog Delta Value
+#define AT91C_WDTC_WDDBGHLT   (0x1 << 28) // (WDTC) Watchdog Debug Halt
+#define AT91C_WDTC_WDIDLEHLT  (0x1 << 29) // (WDTC) Watchdog Idle Halt
+// -------- WDTC_WDSR : (WDTC Offset: 0x8) Watchdog Status Register -------- 
+#define AT91C_WDTC_WDUNF      (0x1 <<  0) // (WDTC) Watchdog Underflow
+#define AT91C_WDTC_WDERR      (0x1 <<  1) // (WDTC) Watchdog Error
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Real-time Clock Alarm and Parallel Load Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_RTC {
+	AT91_REG	 RTC_CR; 	// Control Register
+	AT91_REG	 RTC_MR; 	// Mode Register
+	AT91_REG	 RTC_TIMR; 	// Time Register
+	AT91_REG	 RTC_CALR; 	// Calendar Register
+	AT91_REG	 RTC_TIMALR; 	// Time Alarm Register
+	AT91_REG	 RTC_CALALR; 	// Calendar Alarm Register
+	AT91_REG	 RTC_SR; 	// Status Register
+	AT91_REG	 RTC_SCCR; 	// Status Clear Command Register
+	AT91_REG	 RTC_IER; 	// Interrupt Enable Register
+	AT91_REG	 RTC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 RTC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 RTC_VER; 	// Valid Entry Register
+} AT91S_RTC, *AT91PS_RTC;
+#else
+#define RTC_CR          (AT91_CAST(AT91_REG *) 	0x00000000) // (RTC_CR) Control Register
+#define RTC_MR          (AT91_CAST(AT91_REG *) 	0x00000004) // (RTC_MR) Mode Register
+#define RTC_TIMR        (AT91_CAST(AT91_REG *) 	0x00000008) // (RTC_TIMR) Time Register
+#define RTC_CALR        (AT91_CAST(AT91_REG *) 	0x0000000C) // (RTC_CALR) Calendar Register
+#define RTC_TIMALR      (AT91_CAST(AT91_REG *) 	0x00000010) // (RTC_TIMALR) Time Alarm Register
+#define RTC_CALALR      (AT91_CAST(AT91_REG *) 	0x00000014) // (RTC_CALALR) Calendar Alarm Register
+#define RTC_SR          (AT91_CAST(AT91_REG *) 	0x00000018) // (RTC_SR) Status Register
+#define RTC_SCCR        (AT91_CAST(AT91_REG *) 	0x0000001C) // (RTC_SCCR) Status Clear Command Register
+#define RTC_IER         (AT91_CAST(AT91_REG *) 	0x00000020) // (RTC_IER) Interrupt Enable Register
+#define RTC_IDR         (AT91_CAST(AT91_REG *) 	0x00000024) // (RTC_IDR) Interrupt Disable Register
+#define RTC_IMR         (AT91_CAST(AT91_REG *) 	0x00000028) // (RTC_IMR) Interrupt Mask Register
+#define RTC_VER         (AT91_CAST(AT91_REG *) 	0x0000002C) // (RTC_VER) Valid Entry Register
+
+#endif
+// -------- RTC_CR : (RTC Offset: 0x0) RTC Control Register -------- 
+#define AT91C_RTC_UPDTIM      (0x1 <<  0) // (RTC) Update Request Time Register
+#define AT91C_RTC_UPDCAL      (0x1 <<  1) // (RTC) Update Request Calendar Register
+#define AT91C_RTC_TIMEVSEL    (0x3 <<  8) // (RTC) Time Event Selection
+#define 	AT91C_RTC_TIMEVSEL_MINUTE               (0x0 <<  8) // (RTC) Minute change.
+#define 	AT91C_RTC_TIMEVSEL_HOUR                 (0x1 <<  8) // (RTC) Hour change.
+#define 	AT91C_RTC_TIMEVSEL_DAY24                (0x2 <<  8) // (RTC) Every day at midnight.
+#define 	AT91C_RTC_TIMEVSEL_DAY12                (0x3 <<  8) // (RTC) Every day at noon.
+#define AT91C_RTC_CALEVSEL    (0x3 << 16) // (RTC) Calendar Event Selection
+#define 	AT91C_RTC_CALEVSEL_WEEK                 (0x0 << 16) // (RTC) Week change (every Monday at time 00:00:00).
+#define 	AT91C_RTC_CALEVSEL_MONTH                (0x1 << 16) // (RTC) Month change (every 01 of each month at time 00:00:00).
+#define 	AT91C_RTC_CALEVSEL_YEAR                 (0x2 << 16) // (RTC) Year change (every January 1 at time 00:00:00).
+// -------- RTC_MR : (RTC Offset: 0x4) RTC Mode Register -------- 
+#define AT91C_RTC_HRMOD       (0x1 <<  0) // (RTC) 12-24 hour Mode
+// -------- RTC_TIMR : (RTC Offset: 0x8) RTC Time Register -------- 
+#define AT91C_RTC_SEC         (0x7F <<  0) // (RTC) Current Second
+#define AT91C_RTC_MIN         (0x7F <<  8) // (RTC) Current Minute
+#define AT91C_RTC_HOUR        (0x3F << 16) // (RTC) Current Hour
+#define AT91C_RTC_AMPM        (0x1 << 22) // (RTC) Ante Meridiem, Post Meridiem Indicator
+// -------- RTC_CALR : (RTC Offset: 0xc) RTC Calendar Register -------- 
+#define AT91C_RTC_CENT        (0x3F <<  0) // (RTC) Current Century
+#define AT91C_RTC_YEAR        (0xFF <<  8) // (RTC) Current Year
+#define AT91C_RTC_MONTH       (0x1F << 16) // (RTC) Current Month
+#define AT91C_RTC_DAY         (0x7 << 21) // (RTC) Current Day
+#define AT91C_RTC_DATE        (0x3F << 24) // (RTC) Current Date
+// -------- RTC_TIMALR : (RTC Offset: 0x10) RTC Time Alarm Register -------- 
+#define AT91C_RTC_SECEN       (0x1 <<  7) // (RTC) Second Alarm Enable
+#define AT91C_RTC_MINEN       (0x1 << 15) // (RTC) Minute Alarm
+#define AT91C_RTC_HOUREN      (0x1 << 23) // (RTC) Current Hour
+// -------- RTC_CALALR : (RTC Offset: 0x14) RTC Calendar Alarm Register -------- 
+#define AT91C_RTC_MONTHEN     (0x1 << 23) // (RTC) Month Alarm Enable
+#define AT91C_RTC_DATEEN      (0x1 << 31) // (RTC) Date Alarm Enable
+// -------- RTC_SR : (RTC Offset: 0x18) RTC Status Register -------- 
+#define AT91C_RTC_ACKUPD      (0x1 <<  0) // (RTC) Acknowledge for Update
+#define AT91C_RTC_ALARM       (0x1 <<  1) // (RTC) Alarm Flag
+#define AT91C_RTC_SECEV       (0x1 <<  2) // (RTC) Second Event
+#define AT91C_RTC_TIMEV       (0x1 <<  3) // (RTC) Time Event
+#define AT91C_RTC_CALEV       (0x1 <<  4) // (RTC) Calendar event
+// -------- RTC_SCCR : (RTC Offset: 0x1c) RTC Status Clear Command Register -------- 
+// -------- RTC_IER : (RTC Offset: 0x20) RTC Interrupt Enable Register -------- 
+// -------- RTC_IDR : (RTC Offset: 0x24) RTC Interrupt Disable Register -------- 
+// -------- RTC_IMR : (RTC Offset: 0x28) RTC Interrupt Mask Register -------- 
+// -------- RTC_VER : (RTC Offset: 0x2c) RTC Valid Entry Register -------- 
+#define AT91C_RTC_NVTIM       (0x1 <<  0) // (RTC) Non valid Time
+#define AT91C_RTC_NVCAL       (0x1 <<  1) // (RTC) Non valid Calendar
+#define AT91C_RTC_NVTIMALR    (0x1 <<  2) // (RTC) Non valid time Alarm
+#define AT91C_RTC_NVCALALR    (0x1 <<  3) // (RTC) Nonvalid Calendar Alarm
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Timer Counter Channel Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_TC {
+	AT91_REG	 TC_CCR; 	// Channel Control Register
+	AT91_REG	 TC_CMR; 	// Channel Mode Register (Capture Mode / Waveform Mode)
+	AT91_REG	 Reserved0[2]; 	// 
+	AT91_REG	 TC_CV; 	// Counter Value
+	AT91_REG	 TC_RA; 	// Register A
+	AT91_REG	 TC_RB; 	// Register B
+	AT91_REG	 TC_RC; 	// Register C
+	AT91_REG	 TC_SR; 	// Status Register
+	AT91_REG	 TC_IER; 	// Interrupt Enable Register
+	AT91_REG	 TC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 TC_IMR; 	// Interrupt Mask Register
+} AT91S_TC, *AT91PS_TC;
+#else
+#define TC_CCR          (AT91_CAST(AT91_REG *) 	0x00000000) // (TC_CCR) Channel Control Register
+#define TC_CMR          (AT91_CAST(AT91_REG *) 	0x00000004) // (TC_CMR) Channel Mode Register (Capture Mode / Waveform Mode)
+#define TC_CV           (AT91_CAST(AT91_REG *) 	0x00000010) // (TC_CV) Counter Value
+#define TC_RA           (AT91_CAST(AT91_REG *) 	0x00000014) // (TC_RA) Register A
+#define TC_RB           (AT91_CAST(AT91_REG *) 	0x00000018) // (TC_RB) Register B
+#define TC_RC           (AT91_CAST(AT91_REG *) 	0x0000001C) // (TC_RC) Register C
+#define TC_SR           (AT91_CAST(AT91_REG *) 	0x00000020) // (TC_SR) Status Register
+#define TC_IER          (AT91_CAST(AT91_REG *) 	0x00000024) // (TC_IER) Interrupt Enable Register
+#define TC_IDR          (AT91_CAST(AT91_REG *) 	0x00000028) // (TC_IDR) Interrupt Disable Register
+#define TC_IMR          (AT91_CAST(AT91_REG *) 	0x0000002C) // (TC_IMR) Interrupt Mask Register
+
+#endif
+// -------- TC_CCR : (TC Offset: 0x0) TC Channel Control Register -------- 
+#define AT91C_TC_CLKEN        (0x1 <<  0) // (TC) Counter Clock Enable Command
+#define AT91C_TC_CLKDIS       (0x1 <<  1) // (TC) Counter Clock Disable Command
+#define AT91C_TC_SWTRG        (0x1 <<  2) // (TC) Software Trigger Command
+// -------- TC_CMR : (TC Offset: 0x4) TC Channel Mode Register: Capture Mode / Waveform Mode -------- 
+#define AT91C_TC_CLKS         (0x7 <<  0) // (TC) Clock Selection
+#define 	AT91C_TC_CLKS_TIMER_DIV1_CLOCK     (0x0) // (TC) Clock selected: TIMER_DIV1_CLOCK
+#define 	AT91C_TC_CLKS_TIMER_DIV2_CLOCK     (0x1) // (TC) Clock selected: TIMER_DIV2_CLOCK
+#define 	AT91C_TC_CLKS_TIMER_DIV3_CLOCK     (0x2) // (TC) Clock selected: TIMER_DIV3_CLOCK
+#define 	AT91C_TC_CLKS_TIMER_DIV4_CLOCK     (0x3) // (TC) Clock selected: TIMER_DIV4_CLOCK
+#define 	AT91C_TC_CLKS_TIMER_DIV5_CLOCK     (0x4) // (TC) Clock selected: TIMER_DIV5_CLOCK
+#define 	AT91C_TC_CLKS_XC0                  (0x5) // (TC) Clock selected: XC0
+#define 	AT91C_TC_CLKS_XC1                  (0x6) // (TC) Clock selected: XC1
+#define 	AT91C_TC_CLKS_XC2                  (0x7) // (TC) Clock selected: XC2
+#define AT91C_TC_CLKI         (0x1 <<  3) // (TC) Clock Invert
+#define AT91C_TC_BURST        (0x3 <<  4) // (TC) Burst Signal Selection
+#define 	AT91C_TC_BURST_NONE                 (0x0 <<  4) // (TC) The clock is not gated by an external signal
+#define 	AT91C_TC_BURST_XC0                  (0x1 <<  4) // (TC) XC0 is ANDed with the selected clock
+#define 	AT91C_TC_BURST_XC1                  (0x2 <<  4) // (TC) XC1 is ANDed with the selected clock
+#define 	AT91C_TC_BURST_XC2                  (0x3 <<  4) // (TC) XC2 is ANDed with the selected clock
+#define AT91C_TC_CPCSTOP      (0x1 <<  6) // (TC) Counter Clock Stopped with RC Compare
+#define AT91C_TC_LDBSTOP      (0x1 <<  6) // (TC) Counter Clock Stopped with RB Loading
+#define AT91C_TC_CPCDIS       (0x1 <<  7) // (TC) Counter Clock Disable with RC Compare
+#define AT91C_TC_LDBDIS       (0x1 <<  7) // (TC) Counter Clock Disabled with RB Loading
+#define AT91C_TC_ETRGEDG      (0x3 <<  8) // (TC) External Trigger Edge Selection
+#define 	AT91C_TC_ETRGEDG_NONE                 (0x0 <<  8) // (TC) Edge: None
+#define 	AT91C_TC_ETRGEDG_RISING               (0x1 <<  8) // (TC) Edge: rising edge
+#define 	AT91C_TC_ETRGEDG_FALLING              (0x2 <<  8) // (TC) Edge: falling edge
+#define 	AT91C_TC_ETRGEDG_BOTH                 (0x3 <<  8) // (TC) Edge: each edge
+#define AT91C_TC_EEVTEDG      (0x3 <<  8) // (TC) External Event Edge Selection
+#define 	AT91C_TC_EEVTEDG_NONE                 (0x0 <<  8) // (TC) Edge: None
+#define 	AT91C_TC_EEVTEDG_RISING               (0x1 <<  8) // (TC) Edge: rising edge
+#define 	AT91C_TC_EEVTEDG_FALLING              (0x2 <<  8) // (TC) Edge: falling edge
+#define 	AT91C_TC_EEVTEDG_BOTH                 (0x3 <<  8) // (TC) Edge: each edge
+#define AT91C_TC_EEVT         (0x3 << 10) // (TC) External Event  Selection
+#define 	AT91C_TC_EEVT_TIOB                 (0x0 << 10) // (TC) Signal selected as external event: TIOB TIOB direction: input
+#define 	AT91C_TC_EEVT_XC0                  (0x1 << 10) // (TC) Signal selected as external event: XC0 TIOB direction: output
+#define 	AT91C_TC_EEVT_XC1                  (0x2 << 10) // (TC) Signal selected as external event: XC1 TIOB direction: output
+#define 	AT91C_TC_EEVT_XC2                  (0x3 << 10) // (TC) Signal selected as external event: XC2 TIOB direction: output
+#define AT91C_TC_ABETRG       (0x1 << 10) // (TC) TIOA or TIOB External Trigger Selection
+#define AT91C_TC_ENETRG       (0x1 << 12) // (TC) External Event Trigger enable
+#define AT91C_TC_WAVESEL      (0x3 << 13) // (TC) Waveform  Selection
+#define 	AT91C_TC_WAVESEL_UP                   (0x0 << 13) // (TC) UP mode without atomatic trigger on RC Compare
+#define 	AT91C_TC_WAVESEL_UPDOWN               (0x1 << 13) // (TC) UPDOWN mode without automatic trigger on RC Compare
+#define 	AT91C_TC_WAVESEL_UP_AUTO              (0x2 << 13) // (TC) UP mode with automatic trigger on RC Compare
+#define 	AT91C_TC_WAVESEL_UPDOWN_AUTO          (0x3 << 13) // (TC) UPDOWN mode with automatic trigger on RC Compare
+#define AT91C_TC_CPCTRG       (0x1 << 14) // (TC) RC Compare Trigger Enable
+#define AT91C_TC_WAVE         (0x1 << 15) // (TC) 
+#define AT91C_TC_ACPA         (0x3 << 16) // (TC) RA Compare Effect on TIOA
+#define 	AT91C_TC_ACPA_NONE                 (0x0 << 16) // (TC) Effect: none
+#define 	AT91C_TC_ACPA_SET                  (0x1 << 16) // (TC) Effect: set
+#define 	AT91C_TC_ACPA_CLEAR                (0x2 << 16) // (TC) Effect: clear
+#define 	AT91C_TC_ACPA_TOGGLE               (0x3 << 16) // (TC) Effect: toggle
+#define AT91C_TC_LDRA         (0x3 << 16) // (TC) RA Loading Selection
+#define 	AT91C_TC_LDRA_NONE                 (0x0 << 16) // (TC) Edge: None
+#define 	AT91C_TC_LDRA_RISING               (0x1 << 16) // (TC) Edge: rising edge of TIOA
+#define 	AT91C_TC_LDRA_FALLING              (0x2 << 16) // (TC) Edge: falling edge of TIOA
+#define 	AT91C_TC_LDRA_BOTH                 (0x3 << 16) // (TC) Edge: each edge of TIOA
+#define AT91C_TC_ACPC         (0x3 << 18) // (TC) RC Compare Effect on TIOA
+#define 	AT91C_TC_ACPC_NONE                 (0x0 << 18) // (TC) Effect: none
+#define 	AT91C_TC_ACPC_SET                  (0x1 << 18) // (TC) Effect: set
+#define 	AT91C_TC_ACPC_CLEAR                (0x2 << 18) // (TC) Effect: clear
+#define 	AT91C_TC_ACPC_TOGGLE               (0x3 << 18) // (TC) Effect: toggle
+#define AT91C_TC_LDRB         (0x3 << 18) // (TC) RB Loading Selection
+#define 	AT91C_TC_LDRB_NONE                 (0x0 << 18) // (TC) Edge: None
+#define 	AT91C_TC_LDRB_RISING               (0x1 << 18) // (TC) Edge: rising edge of TIOA
+#define 	AT91C_TC_LDRB_FALLING              (0x2 << 18) // (TC) Edge: falling edge of TIOA
+#define 	AT91C_TC_LDRB_BOTH                 (0x3 << 18) // (TC) Edge: each edge of TIOA
+#define AT91C_TC_AEEVT        (0x3 << 20) // (TC) External Event Effect on TIOA
+#define 	AT91C_TC_AEEVT_NONE                 (0x0 << 20) // (TC) Effect: none
+#define 	AT91C_TC_AEEVT_SET                  (0x1 << 20) // (TC) Effect: set
+#define 	AT91C_TC_AEEVT_CLEAR                (0x2 << 20) // (TC) Effect: clear
+#define 	AT91C_TC_AEEVT_TOGGLE               (0x3 << 20) // (TC) Effect: toggle
+#define AT91C_TC_ASWTRG       (0x3 << 22) // (TC) Software Trigger Effect on TIOA
+#define 	AT91C_TC_ASWTRG_NONE                 (0x0 << 22) // (TC) Effect: none
+#define 	AT91C_TC_ASWTRG_SET                  (0x1 << 22) // (TC) Effect: set
+#define 	AT91C_TC_ASWTRG_CLEAR                (0x2 << 22) // (TC) Effect: clear
+#define 	AT91C_TC_ASWTRG_TOGGLE               (0x3 << 22) // (TC) Effect: toggle
+#define AT91C_TC_BCPB         (0x3 << 24) // (TC) RB Compare Effect on TIOB
+#define 	AT91C_TC_BCPB_NONE                 (0x0 << 24) // (TC) Effect: none
+#define 	AT91C_TC_BCPB_SET                  (0x1 << 24) // (TC) Effect: set
+#define 	AT91C_TC_BCPB_CLEAR                (0x2 << 24) // (TC) Effect: clear
+#define 	AT91C_TC_BCPB_TOGGLE               (0x3 << 24) // (TC) Effect: toggle
+#define AT91C_TC_BCPC         (0x3 << 26) // (TC) RC Compare Effect on TIOB
+#define 	AT91C_TC_BCPC_NONE                 (0x0 << 26) // (TC) Effect: none
+#define 	AT91C_TC_BCPC_SET                  (0x1 << 26) // (TC) Effect: set
+#define 	AT91C_TC_BCPC_CLEAR                (0x2 << 26) // (TC) Effect: clear
+#define 	AT91C_TC_BCPC_TOGGLE               (0x3 << 26) // (TC) Effect: toggle
+#define AT91C_TC_BEEVT        (0x3 << 28) // (TC) External Event Effect on TIOB
+#define 	AT91C_TC_BEEVT_NONE                 (0x0 << 28) // (TC) Effect: none
+#define 	AT91C_TC_BEEVT_SET                  (0x1 << 28) // (TC) Effect: set
+#define 	AT91C_TC_BEEVT_CLEAR                (0x2 << 28) // (TC) Effect: clear
+#define 	AT91C_TC_BEEVT_TOGGLE               (0x3 << 28) // (TC) Effect: toggle
+#define AT91C_TC_BSWTRG       (0x3 << 30) // (TC) Software Trigger Effect on TIOB
+#define 	AT91C_TC_BSWTRG_NONE                 (0x0 << 30) // (TC) Effect: none
+#define 	AT91C_TC_BSWTRG_SET                  (0x1 << 30) // (TC) Effect: set
+#define 	AT91C_TC_BSWTRG_CLEAR                (0x2 << 30) // (TC) Effect: clear
+#define 	AT91C_TC_BSWTRG_TOGGLE               (0x3 << 30) // (TC) Effect: toggle
+// -------- TC_SR : (TC Offset: 0x20) TC Channel Status Register -------- 
+#define AT91C_TC_COVFS        (0x1 <<  0) // (TC) Counter Overflow
+#define AT91C_TC_LOVRS        (0x1 <<  1) // (TC) Load Overrun
+#define AT91C_TC_CPAS         (0x1 <<  2) // (TC) RA Compare
+#define AT91C_TC_CPBS         (0x1 <<  3) // (TC) RB Compare
+#define AT91C_TC_CPCS         (0x1 <<  4) // (TC) RC Compare
+#define AT91C_TC_LDRAS        (0x1 <<  5) // (TC) RA Loading
+#define AT91C_TC_LDRBS        (0x1 <<  6) // (TC) RB Loading
+#define AT91C_TC_ETRGS        (0x1 <<  7) // (TC) External Trigger
+#define AT91C_TC_CLKSTA       (0x1 << 16) // (TC) Clock Enabling
+#define AT91C_TC_MTIOA        (0x1 << 17) // (TC) TIOA Mirror
+#define AT91C_TC_MTIOB        (0x1 << 18) // (TC) TIOA Mirror
+// -------- TC_IER : (TC Offset: 0x24) TC Channel Interrupt Enable Register -------- 
+// -------- TC_IDR : (TC Offset: 0x28) TC Channel Interrupt Disable Register -------- 
+// -------- TC_IMR : (TC Offset: 0x2c) TC Channel Interrupt Mask Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Timer Counter Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_TCB {
+	AT91S_TC	 TCB_TC0; 	// TC Channel 0
+	AT91_REG	 Reserved0[4]; 	// 
+	AT91S_TC	 TCB_TC1; 	// TC Channel 1
+	AT91_REG	 Reserved1[4]; 	// 
+	AT91S_TC	 TCB_TC2; 	// TC Channel 2
+	AT91_REG	 Reserved2[4]; 	// 
+	AT91_REG	 TCB_BCR; 	// TC Block Control Register
+	AT91_REG	 TCB_BMR; 	// TC Block Mode Register
+	AT91_REG	 Reserved3[9]; 	// 
+	AT91_REG	 TCB_ADDRSIZE; 	// TC ADDRSIZE REGISTER 
+	AT91_REG	 TCB_IPNAME1; 	// TC IPNAME1 REGISTER 
+	AT91_REG	 TCB_IPNAME2; 	// TC IPNAME2 REGISTER 
+	AT91_REG	 TCB_FEATURES; 	// TC FEATURES REGISTER 
+	AT91_REG	 TCB_VER; 	//  Version Register
+} AT91S_TCB, *AT91PS_TCB;
+#else
+#define TCB_BCR         (AT91_CAST(AT91_REG *) 	0x000000C0) // (TCB_BCR) TC Block Control Register
+#define TCB_BMR         (AT91_CAST(AT91_REG *) 	0x000000C4) // (TCB_BMR) TC Block Mode Register
+#define TC_ADDRSIZE     (AT91_CAST(AT91_REG *) 	0x000000EC) // (TC_ADDRSIZE) TC ADDRSIZE REGISTER 
+#define TC_IPNAME1      (AT91_CAST(AT91_REG *) 	0x000000F0) // (TC_IPNAME1) TC IPNAME1 REGISTER 
+#define TC_IPNAME2      (AT91_CAST(AT91_REG *) 	0x000000F4) // (TC_IPNAME2) TC IPNAME2 REGISTER 
+#define TC_FEATURES     (AT91_CAST(AT91_REG *) 	0x000000F8) // (TC_FEATURES) TC FEATURES REGISTER 
+#define TC_VER          (AT91_CAST(AT91_REG *) 	0x000000FC) // (TC_VER)  Version Register
+
+#endif
+// -------- TCB_BCR : (TCB Offset: 0xc0) TC Block Control Register -------- 
+#define AT91C_TCB_SYNC        (0x1 <<  0) // (TCB) Synchro Command
+// -------- TCB_BMR : (TCB Offset: 0xc4) TC Block Mode Register -------- 
+#define AT91C_TCB_TC0XC0S     (0x3 <<  0) // (TCB) External Clock Signal 0 Selection
+#define 	AT91C_TCB_TC0XC0S_TCLK0                (0x0) // (TCB) TCLK0 connected to XC0
+#define 	AT91C_TCB_TC0XC0S_NONE                 (0x1) // (TCB) None signal connected to XC0
+#define 	AT91C_TCB_TC0XC0S_TIOA1                (0x2) // (TCB) TIOA1 connected to XC0
+#define 	AT91C_TCB_TC0XC0S_TIOA2                (0x3) // (TCB) TIOA2 connected to XC0
+#define AT91C_TCB_TC1XC1S     (0x3 <<  2) // (TCB) External Clock Signal 1 Selection
+#define 	AT91C_TCB_TC1XC1S_TCLK1                (0x0 <<  2) // (TCB) TCLK1 connected to XC1
+#define 	AT91C_TCB_TC1XC1S_NONE                 (0x1 <<  2) // (TCB) None signal connected to XC1
+#define 	AT91C_TCB_TC1XC1S_TIOA0                (0x2 <<  2) // (TCB) TIOA0 connected to XC1
+#define 	AT91C_TCB_TC1XC1S_TIOA2                (0x3 <<  2) // (TCB) TIOA2 connected to XC1
+#define AT91C_TCB_TC2XC2S     (0x3 <<  4) // (TCB) External Clock Signal 2 Selection
+#define 	AT91C_TCB_TC2XC2S_TCLK2                (0x0 <<  4) // (TCB) TCLK2 connected to XC2
+#define 	AT91C_TCB_TC2XC2S_NONE                 (0x1 <<  4) // (TCB) None signal connected to XC2
+#define 	AT91C_TCB_TC2XC2S_TIOA0                (0x2 <<  4) // (TCB) TIOA0 connected to XC2
+#define 	AT91C_TCB_TC2XC2S_TIOA1                (0x3 <<  4) // (TCB) TIOA2 connected to XC2
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Multimedia Card Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_MCI {
+	AT91_REG	 MCI_CR; 	// MCI Control Register
+	AT91_REG	 MCI_MR; 	// MCI Mode Register
+	AT91_REG	 MCI_DTOR; 	// MCI Data Timeout Register
+	AT91_REG	 MCI_SDCR; 	// MCI SD/SDIO Card Register
+	AT91_REG	 MCI_ARGR; 	// MCI Argument Register
+	AT91_REG	 MCI_CMDR; 	// MCI Command Register
+	AT91_REG	 MCI_BLKR; 	// MCI Block Register
+	AT91_REG	 MCI_CSTOR; 	// MCI Completion Signal Timeout Register
+	AT91_REG	 MCI_RSPR[4]; 	// MCI Response Register
+	AT91_REG	 MCI_RDR; 	// MCI Receive Data Register
+	AT91_REG	 MCI_TDR; 	// MCI Transmit Data Register
+	AT91_REG	 Reserved0[2]; 	// 
+	AT91_REG	 MCI_SR; 	// MCI Status Register
+	AT91_REG	 MCI_IER; 	// MCI Interrupt Enable Register
+	AT91_REG	 MCI_IDR; 	// MCI Interrupt Disable Register
+	AT91_REG	 MCI_IMR; 	// MCI Interrupt Mask Register
+	AT91_REG	 MCI_DMA; 	// MCI DMA Configuration Register
+	AT91_REG	 MCI_CFG; 	// MCI Configuration Register
+	AT91_REG	 Reserved1[35]; 	// 
+	AT91_REG	 MCI_WPCR; 	// MCI Write Protection Control Register
+	AT91_REG	 MCI_WPSR; 	// MCI Write Protection Status Register
+	AT91_REG	 MCI_ADDRSIZE; 	// MCI ADDRSIZE REGISTER 
+	AT91_REG	 MCI_IPNAME1; 	// MCI IPNAME1 REGISTER 
+	AT91_REG	 MCI_IPNAME2; 	// MCI IPNAME2 REGISTER 
+	AT91_REG	 MCI_FEATURES; 	// MCI FEATURES REGISTER 
+	AT91_REG	 MCI_VER; 	// MCI VERSION REGISTER 
+	AT91_REG	 MCI_RPR; 	// Receive Pointer Register
+	AT91_REG	 MCI_RCR; 	// Receive Counter Register
+	AT91_REG	 MCI_TPR; 	// Transmit Pointer Register
+	AT91_REG	 MCI_TCR; 	// Transmit Counter Register
+	AT91_REG	 MCI_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 MCI_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 MCI_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 MCI_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 MCI_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 MCI_PTSR; 	// PDC Transfer Status Register
+	AT91_REG	 Reserved2[54]; 	// 
+	AT91_REG	 MCI_FIFO; 	// MCI FIFO Aperture Register
+} AT91S_MCI, *AT91PS_MCI;
+#else
+#define MCI_CR          (AT91_CAST(AT91_REG *) 	0x00000000) // (MCI_CR) MCI Control Register
+#define MCI_MR          (AT91_CAST(AT91_REG *) 	0x00000004) // (MCI_MR) MCI Mode Register
+#define MCI_DTOR        (AT91_CAST(AT91_REG *) 	0x00000008) // (MCI_DTOR) MCI Data Timeout Register
+#define MCI_SDCR        (AT91_CAST(AT91_REG *) 	0x0000000C) // (MCI_SDCR) MCI SD/SDIO Card Register
+#define MCI_ARGR        (AT91_CAST(AT91_REG *) 	0x00000010) // (MCI_ARGR) MCI Argument Register
+#define MCI_CMDR        (AT91_CAST(AT91_REG *) 	0x00000014) // (MCI_CMDR) MCI Command Register
+#define MCI_BLKR        (AT91_CAST(AT91_REG *) 	0x00000018) // (MCI_BLKR) MCI Block Register
+#define MCI_CSTOR       (AT91_CAST(AT91_REG *) 	0x0000001C) // (MCI_CSTOR) MCI Completion Signal Timeout Register
+#define MCI_RSPR        (AT91_CAST(AT91_REG *) 	0x00000020) // (MCI_RSPR) MCI Response Register
+#define MCI_RDR         (AT91_CAST(AT91_REG *) 	0x00000030) // (MCI_RDR) MCI Receive Data Register
+#define MCI_TDR         (AT91_CAST(AT91_REG *) 	0x00000034) // (MCI_TDR) MCI Transmit Data Register
+#define MCI_SR          (AT91_CAST(AT91_REG *) 	0x00000040) // (MCI_SR) MCI Status Register
+#define MCI_IER         (AT91_CAST(AT91_REG *) 	0x00000044) // (MCI_IER) MCI Interrupt Enable Register
+#define MCI_IDR         (AT91_CAST(AT91_REG *) 	0x00000048) // (MCI_IDR) MCI Interrupt Disable Register
+#define MCI_IMR         (AT91_CAST(AT91_REG *) 	0x0000004C) // (MCI_IMR) MCI Interrupt Mask Register
+#define MCI_DMA         (AT91_CAST(AT91_REG *) 	0x00000050) // (MCI_DMA) MCI DMA Configuration Register
+#define MCI_CFG         (AT91_CAST(AT91_REG *) 	0x00000054) // (MCI_CFG) MCI Configuration Register
+#define MCI_WPCR        (AT91_CAST(AT91_REG *) 	0x000000E4) // (MCI_WPCR) MCI Write Protection Control Register
+#define MCI_WPSR        (AT91_CAST(AT91_REG *) 	0x000000E8) // (MCI_WPSR) MCI Write Protection Status Register
+#define MCI_ADDRSIZE    (AT91_CAST(AT91_REG *) 	0x000000EC) // (MCI_ADDRSIZE) MCI ADDRSIZE REGISTER 
+#define MCI_IPNAME1     (AT91_CAST(AT91_REG *) 	0x000000F0) // (MCI_IPNAME1) MCI IPNAME1 REGISTER 
+#define MCI_IPNAME2     (AT91_CAST(AT91_REG *) 	0x000000F4) // (MCI_IPNAME2) MCI IPNAME2 REGISTER 
+#define MCI_FEATURES    (AT91_CAST(AT91_REG *) 	0x000000F8) // (MCI_FEATURES) MCI FEATURES REGISTER 
+#define MCI_VER         (AT91_CAST(AT91_REG *) 	0x000000FC) // (MCI_VER) MCI VERSION REGISTER 
+#define MCI_FIFO        (AT91_CAST(AT91_REG *) 	0x00000200) // (MCI_FIFO) MCI FIFO Aperture Register
+
+#endif
+// -------- MCI_CR : (MCI Offset: 0x0) MCI Control Register -------- 
+#define AT91C_MCI_MCIEN       (0x1 <<  0) // (MCI) Multimedia Interface Enable
+#define 	AT91C_MCI_MCIEN_0                    (0x0) // (MCI) No effect
+#define 	AT91C_MCI_MCIEN_1                    (0x1) // (MCI) Enable the MultiMedia Interface if MCIDIS is 0
+#define AT91C_MCI_MCIDIS      (0x1 <<  1) // (MCI) Multimedia Interface Disable
+#define 	AT91C_MCI_MCIDIS_0                    (0x0 <<  1) // (MCI) No effect
+#define 	AT91C_MCI_MCIDIS_1                    (0x1 <<  1) // (MCI) Disable the MultiMedia Interface
+#define AT91C_MCI_PWSEN       (0x1 <<  2) // (MCI) Power Save Mode Enable
+#define 	AT91C_MCI_PWSEN_0                    (0x0 <<  2) // (MCI) No effect
+#define 	AT91C_MCI_PWSEN_1                    (0x1 <<  2) // (MCI) Enable the Power-saving mode if PWSDIS is 0.
+#define AT91C_MCI_PWSDIS      (0x1 <<  3) // (MCI) Power Save Mode Disable
+#define 	AT91C_MCI_PWSDIS_0                    (0x0 <<  3) // (MCI) No effect
+#define 	AT91C_MCI_PWSDIS_1                    (0x1 <<  3) // (MCI) Disable the Power-saving mode.
+#define AT91C_MCI_IOWAITEN    (0x1 <<  4) // (MCI) SDIO Read Wait Enable
+#define 	AT91C_MCI_IOWAITEN_0                    (0x0 <<  4) // (MCI) No effect
+#define 	AT91C_MCI_IOWAITEN_1                    (0x1 <<  4) // (MCI) Enables the SDIO Read Wait Operation.
+#define AT91C_MCI_IOWAITDIS   (0x1 <<  5) // (MCI) SDIO Read Wait Disable
+#define 	AT91C_MCI_IOWAITDIS_0                    (0x0 <<  5) // (MCI) No effect
+#define 	AT91C_MCI_IOWAITDIS_1                    (0x1 <<  5) // (MCI) Disables the SDIO Read Wait Operation.
+#define AT91C_MCI_SWRST       (0x1 <<  7) // (MCI) MCI Software reset
+#define 	AT91C_MCI_SWRST_0                    (0x0 <<  7) // (MCI) No effect
+#define 	AT91C_MCI_SWRST_1                    (0x1 <<  7) // (MCI) Resets the MCI
+// -------- MCI_MR : (MCI Offset: 0x4) MCI Mode Register -------- 
+#define AT91C_MCI_CLKDIV      (0xFF <<  0) // (MCI) Clock Divider
+#define AT91C_MCI_PWSDIV      (0x7 <<  8) // (MCI) Power Saving Divider
+#define AT91C_MCI_RDPROOF     (0x1 << 11) // (MCI) Read Proof Enable
+#define 	AT91C_MCI_RDPROOF_DISABLE              (0x0 << 11) // (MCI) Disables Read Proof
+#define 	AT91C_MCI_RDPROOF_ENABLE               (0x1 << 11) // (MCI) Enables Read Proof
+#define AT91C_MCI_WRPROOF     (0x1 << 12) // (MCI) Write Proof Enable
+#define 	AT91C_MCI_WRPROOF_DISABLE              (0x0 << 12) // (MCI) Disables Write Proof
+#define 	AT91C_MCI_WRPROOF_ENABLE               (0x1 << 12) // (MCI) Enables Write Proof
+#define AT91C_MCI_PDCFBYTE    (0x1 << 13) // (MCI) PDC Force Byte Transfer
+#define 	AT91C_MCI_PDCFBYTE_DISABLE              (0x0 << 13) // (MCI) Disables PDC Force Byte Transfer
+#define 	AT91C_MCI_PDCFBYTE_ENABLE               (0x1 << 13) // (MCI) Enables PDC Force Byte Transfer
+#define AT91C_MCI_PDCPADV     (0x1 << 14) // (MCI) PDC Padding Value
+#define AT91C_MCI_PDCMODE     (0x1 << 15) // (MCI) PDC Oriented Mode
+#define 	AT91C_MCI_PDCMODE_DISABLE              (0x0 << 15) // (MCI) Disables PDC Transfer
+#define 	AT91C_MCI_PDCMODE_ENABLE               (0x1 << 15) // (MCI) Enables PDC Transfer
+#define AT91C_MCI_BLKLEN      (0xFFFF << 16) // (MCI) Data Block Length
+// -------- MCI_DTOR : (MCI Offset: 0x8) MCI Data Timeout Register -------- 
+#define AT91C_MCI_DTOCYC      (0xF <<  0) // (MCI) Data Timeout Cycle Number
+#define AT91C_MCI_DTOMUL      (0x7 <<  4) // (MCI) Data Timeout Multiplier
+#define 	AT91C_MCI_DTOMUL_1                    (0x0 <<  4) // (MCI) DTOCYC x 1
+#define 	AT91C_MCI_DTOMUL_16                   (0x1 <<  4) // (MCI) DTOCYC x 16
+#define 	AT91C_MCI_DTOMUL_128                  (0x2 <<  4) // (MCI) DTOCYC x 128
+#define 	AT91C_MCI_DTOMUL_256                  (0x3 <<  4) // (MCI) DTOCYC x 256
+#define 	AT91C_MCI_DTOMUL_1024                 (0x4 <<  4) // (MCI) DTOCYC x 1024
+#define 	AT91C_MCI_DTOMUL_4096                 (0x5 <<  4) // (MCI) DTOCYC x 4096
+#define 	AT91C_MCI_DTOMUL_65536                (0x6 <<  4) // (MCI) DTOCYC x 65536
+#define 	AT91C_MCI_DTOMUL_1048576              (0x7 <<  4) // (MCI) DTOCYC x 1048576
+// -------- MCI_SDCR : (MCI Offset: 0xc) MCI SD Card Register -------- 
+#define AT91C_MCI_SCDSEL      (0x3 <<  0) // (MCI) SD Card/SDIO Selector
+#define 	AT91C_MCI_SCDSEL_SLOTA                (0x0) // (MCI) Slot A selected
+#define 	AT91C_MCI_SCDSEL_SLOTB                (0x1) // (MCI) Slot B selected
+#define 	AT91C_MCI_SCDSEL_SLOTC                (0x2) // (MCI) Slot C selected
+#define 	AT91C_MCI_SCDSEL_SLOTD                (0x3) // (MCI) Slot D selected
+#define AT91C_MCI_SCDBUS      (0x3 <<  6) // (MCI) SDCard/SDIO Bus Width
+#define 	AT91C_MCI_SCDBUS_1BIT                 (0x0 <<  6) // (MCI) 1-bit data bus
+#define 	AT91C_MCI_SCDBUS_4BITS                (0x2 <<  6) // (MCI) 4-bits data bus
+#define 	AT91C_MCI_SCDBUS_8BITS                (0x3 <<  6) // (MCI) 8-bits data bus
+// -------- MCI_CMDR : (MCI Offset: 0x14) MCI Command Register -------- 
+#define AT91C_MCI_CMDNB       (0x3F <<  0) // (MCI) Command Number
+#define AT91C_MCI_RSPTYP      (0x3 <<  6) // (MCI) Response Type
+#define 	AT91C_MCI_RSPTYP_NO                   (0x0 <<  6) // (MCI) No response
+#define 	AT91C_MCI_RSPTYP_48                   (0x1 <<  6) // (MCI) 48-bit response
+#define 	AT91C_MCI_RSPTYP_136                  (0x2 <<  6) // (MCI) 136-bit response
+#define 	AT91C_MCI_RSPTYP_R1B                  (0x3 <<  6) // (MCI) R1b response
+#define AT91C_MCI_SPCMD       (0x7 <<  8) // (MCI) Special CMD
+#define 	AT91C_MCI_SPCMD_NONE                 (0x0 <<  8) // (MCI) Not a special CMD
+#define 	AT91C_MCI_SPCMD_INIT                 (0x1 <<  8) // (MCI) Initialization CMD
+#define 	AT91C_MCI_SPCMD_SYNC                 (0x2 <<  8) // (MCI) Synchronized CMD
+#define 	AT91C_MCI_SPCMD_CE_ATA               (0x3 <<  8) // (MCI) CE-ATA Completion Signal disable CMD
+#define 	AT91C_MCI_SPCMD_IT_CMD               (0x4 <<  8) // (MCI) Interrupt command
+#define 	AT91C_MCI_SPCMD_IT_REP               (0x5 <<  8) // (MCI) Interrupt response
+#define AT91C_MCI_OPDCMD      (0x1 << 11) // (MCI) Open Drain Command
+#define 	AT91C_MCI_OPDCMD_PUSHPULL             (0x0 << 11) // (MCI) Push/pull command
+#define 	AT91C_MCI_OPDCMD_OPENDRAIN            (0x1 << 11) // (MCI) Open drain command
+#define AT91C_MCI_MAXLAT      (0x1 << 12) // (MCI) Maximum Latency for Command to respond
+#define 	AT91C_MCI_MAXLAT_5                    (0x0 << 12) // (MCI) 5 cycles maximum latency
+#define 	AT91C_MCI_MAXLAT_64                   (0x1 << 12) // (MCI) 64 cycles maximum latency
+#define AT91C_MCI_TRCMD       (0x3 << 16) // (MCI) Transfer CMD
+#define 	AT91C_MCI_TRCMD_NO                   (0x0 << 16) // (MCI) No transfer
+#define 	AT91C_MCI_TRCMD_START                (0x1 << 16) // (MCI) Start transfer
+#define 	AT91C_MCI_TRCMD_STOP                 (0x2 << 16) // (MCI) Stop transfer
+#define AT91C_MCI_TRDIR       (0x1 << 18) // (MCI) Transfer Direction
+#define 	AT91C_MCI_TRDIR_WRITE                (0x0 << 18) // (MCI) Write
+#define 	AT91C_MCI_TRDIR_READ                 (0x1 << 18) // (MCI) Read
+#define AT91C_MCI_TRTYP       (0x7 << 19) // (MCI) Transfer Type
+#define 	AT91C_MCI_TRTYP_BLOCK                (0x0 << 19) // (MCI) MMC/SDCard Single Block Transfer type
+#define 	AT91C_MCI_TRTYP_MULTIPLE             (0x1 << 19) // (MCI) MMC/SDCard Multiple Block transfer type
+#define 	AT91C_MCI_TRTYP_STREAM               (0x2 << 19) // (MCI) MMC Stream transfer type
+#define 	AT91C_MCI_TRTYP_SDIO_BYTE            (0x4 << 19) // (MCI) SDIO Byte transfer type
+#define 	AT91C_MCI_TRTYP_SDIO_BLOCK           (0x5 << 19) // (MCI) SDIO Block transfer type
+#define AT91C_MCI_IOSPCMD     (0x3 << 24) // (MCI) SDIO Special Command
+#define 	AT91C_MCI_IOSPCMD_NONE                 (0x0 << 24) // (MCI) NOT a special command
+#define 	AT91C_MCI_IOSPCMD_SUSPEND              (0x1 << 24) // (MCI) SDIO Suspend Command
+#define 	AT91C_MCI_IOSPCMD_RESUME               (0x2 << 24) // (MCI) SDIO Resume Command
+#define AT91C_MCI_ATACS       (0x1 << 26) // (MCI) ATA with command completion signal
+#define 	AT91C_MCI_ATACS_NORMAL               (0x0 << 26) // (MCI) normal operation mode
+#define 	AT91C_MCI_ATACS_COMPLETION           (0x1 << 26) // (MCI) completion signal is expected within MCI_CSTOR
+// -------- MCI_BLKR : (MCI Offset: 0x18) MCI Block Register -------- 
+#define AT91C_MCI_BCNT        (0xFFFF <<  0) // (MCI) MMC/SDIO Block Count / SDIO Byte Count
+// -------- MCI_CSTOR : (MCI Offset: 0x1c) MCI Completion Signal Timeout Register -------- 
+#define AT91C_MCI_CSTOCYC     (0xF <<  0) // (MCI) Completion Signal Timeout Cycle Number
+#define AT91C_MCI_CSTOMUL     (0x7 <<  4) // (MCI) Completion Signal Timeout Multiplier
+#define 	AT91C_MCI_CSTOMUL_1                    (0x0 <<  4) // (MCI) CSTOCYC x 1
+#define 	AT91C_MCI_CSTOMUL_16                   (0x1 <<  4) // (MCI) CSTOCYC x  16
+#define 	AT91C_MCI_CSTOMUL_128                  (0x2 <<  4) // (MCI) CSTOCYC x  128
+#define 	AT91C_MCI_CSTOMUL_256                  (0x3 <<  4) // (MCI) CSTOCYC x  256
+#define 	AT91C_MCI_CSTOMUL_1024                 (0x4 <<  4) // (MCI) CSTOCYC x  1024
+#define 	AT91C_MCI_CSTOMUL_4096                 (0x5 <<  4) // (MCI) CSTOCYC x  4096
+#define 	AT91C_MCI_CSTOMUL_65536                (0x6 <<  4) // (MCI) CSTOCYC x  65536
+#define 	AT91C_MCI_CSTOMUL_1048576              (0x7 <<  4) // (MCI) CSTOCYC x  1048576
+// -------- MCI_SR : (MCI Offset: 0x40) MCI Status Register -------- 
+#define AT91C_MCI_CMDRDY      (0x1 <<  0) // (MCI) Command Ready flag
+#define AT91C_MCI_RXRDY       (0x1 <<  1) // (MCI) RX Ready flag
+#define AT91C_MCI_TXRDY       (0x1 <<  2) // (MCI) TX Ready flag
+#define AT91C_MCI_BLKE        (0x1 <<  3) // (MCI) Data Block Transfer Ended flag
+#define AT91C_MCI_DTIP        (0x1 <<  4) // (MCI) Data Transfer in Progress flag
+#define AT91C_MCI_NOTBUSY     (0x1 <<  5) // (MCI) Data Line Not Busy flag
+#define AT91C_MCI_ENDRX       (0x1 <<  6) // (MCI) End of RX Buffer flag
+#define AT91C_MCI_ENDTX       (0x1 <<  7) // (MCI) End of TX Buffer flag
+#define AT91C_MCI_SDIOIRQA    (0x1 <<  8) // (MCI) SDIO Interrupt for Slot A
+#define AT91C_MCI_SDIOIRQB    (0x1 <<  9) // (MCI) SDIO Interrupt for Slot B
+#define AT91C_MCI_SDIOIRQC    (0x1 << 10) // (MCI) SDIO Interrupt for Slot C
+#define AT91C_MCI_SDIOIRQD    (0x1 << 11) // (MCI) SDIO Interrupt for Slot D
+#define AT91C_MCI_SDIOWAIT    (0x1 << 12) // (MCI) SDIO Read Wait operation flag
+#define AT91C_MCI_CSRCV       (0x1 << 13) // (MCI) CE-ATA Completion Signal flag
+#define AT91C_MCI_RXBUFF      (0x1 << 14) // (MCI) RX Buffer Full flag
+#define AT91C_MCI_TXBUFE      (0x1 << 15) // (MCI) TX Buffer Empty flag
+#define AT91C_MCI_RINDE       (0x1 << 16) // (MCI) Response Index Error flag
+#define AT91C_MCI_RDIRE       (0x1 << 17) // (MCI) Response Direction Error flag
+#define AT91C_MCI_RCRCE       (0x1 << 18) // (MCI) Response CRC Error flag
+#define AT91C_MCI_RENDE       (0x1 << 19) // (MCI) Response End Bit Error flag
+#define AT91C_MCI_RTOE        (0x1 << 20) // (MCI) Response Time-out Error flag
+#define AT91C_MCI_DCRCE       (0x1 << 21) // (MCI) data CRC Error flag
+#define AT91C_MCI_DTOE        (0x1 << 22) // (MCI) Data timeout Error flag
+#define AT91C_MCI_CSTOE       (0x1 << 23) // (MCI) Completion Signal timeout Error flag
+#define AT91C_MCI_BLKOVRE     (0x1 << 24) // (MCI) DMA Block Overrun Error flag
+#define AT91C_MCI_DMADONE     (0x1 << 25) // (MCI) DMA Transfer Done flag
+#define AT91C_MCI_FIFOEMPTY   (0x1 << 26) // (MCI) FIFO Empty flag
+#define AT91C_MCI_XFRDONE     (0x1 << 27) // (MCI) Transfer Done flag
+#define AT91C_MCI_OVRE        (0x1 << 30) // (MCI) Overrun flag
+#define AT91C_MCI_UNRE        (0x1 << 31) // (MCI) Underrun flag
+// -------- MCI_IER : (MCI Offset: 0x44) MCI Interrupt Enable Register -------- 
+// -------- MCI_IDR : (MCI Offset: 0x48) MCI Interrupt Disable Register -------- 
+// -------- MCI_IMR : (MCI Offset: 0x4c) MCI Interrupt Mask Register -------- 
+// -------- MCI_DMA : (MCI Offset: 0x50) MCI DMA Configuration Register -------- 
+#define AT91C_MCI_OFFSET      (0x3 <<  0) // (MCI) DMA Write Buffer Offset
+#define AT91C_MCI_CHKSIZE     (0x7 <<  4) // (MCI) DMA Channel Read/Write Chunk Size
+#define 	AT91C_MCI_CHKSIZE_1                    (0x0 <<  4) // (MCI) Number of data transferred is 1
+#define 	AT91C_MCI_CHKSIZE_4                    (0x1 <<  4) // (MCI) Number of data transferred is 4
+#define 	AT91C_MCI_CHKSIZE_8                    (0x2 <<  4) // (MCI) Number of data transferred is 8
+#define 	AT91C_MCI_CHKSIZE_16                   (0x3 <<  4) // (MCI) Number of data transferred is 16
+#define 	AT91C_MCI_CHKSIZE_32                   (0x4 <<  4) // (MCI) Number of data transferred is 32
+#define AT91C_MCI_DMAEN       (0x1 <<  8) // (MCI) DMA Hardware Handshaking Enable
+#define 	AT91C_MCI_DMAEN_DISABLE              (0x0 <<  8) // (MCI) DMA interface is disabled
+#define 	AT91C_MCI_DMAEN_ENABLE               (0x1 <<  8) // (MCI) DMA interface is enabled
+// -------- MCI_CFG : (MCI Offset: 0x54) MCI Configuration Register -------- 
+#define AT91C_MCI_FIFOMODE    (0x1 <<  0) // (MCI) MCI Internal FIFO Control Mode
+#define 	AT91C_MCI_FIFOMODE_AMOUNTDATA           (0x0) // (MCI) A write transfer starts when a sufficient amount of datas is written into the FIFO
+#define 	AT91C_MCI_FIFOMODE_ONEDATA              (0x1) // (MCI) A write transfer starts as soon as one data is written into the FIFO
+#define AT91C_MCI_FERRCTRL    (0x1 <<  4) // (MCI) Flow Error Flag Reset Control Mode
+#define 	AT91C_MCI_FERRCTRL_RWCMD                (0x0 <<  4) // (MCI) When an underflow/overflow condition flag is set, a new Write/Read command is needed to reset the flag
+#define 	AT91C_MCI_FERRCTRL_READSR               (0x1 <<  4) // (MCI) When an underflow/overflow condition flag is set, a read status resets the flag
+#define AT91C_MCI_HSMODE      (0x1 <<  8) // (MCI) High Speed Mode
+#define 	AT91C_MCI_HSMODE_DISABLE              (0x0 <<  8) // (MCI) Default Bus Timing Mode
+#define 	AT91C_MCI_HSMODE_ENABLE               (0x1 <<  8) // (MCI) High Speed Mode
+#define AT91C_MCI_LSYNC       (0x1 << 12) // (MCI) Synchronize on last block
+#define 	AT91C_MCI_LSYNC_CURRENT              (0x0 << 12) // (MCI) Pending command sent at end of current data block
+#define 	AT91C_MCI_LSYNC_INFINITE             (0x1 << 12) // (MCI) Pending command sent at end of block transfer when transfer length is not infinite
+// -------- MCI_WPCR : (MCI Offset: 0xe4) Write Protection Control Register -------- 
+#define AT91C_MCI_WP_EN       (0x1 <<  0) // (MCI) Write Protection Enable
+#define 	AT91C_MCI_WP_EN_DISABLE              (0x0) // (MCI) Write Operation is disabled (if WP_KEY corresponds)
+#define 	AT91C_MCI_WP_EN_ENABLE               (0x1) // (MCI) Write Operation is enabled (if WP_KEY corresponds)
+#define AT91C_MCI_WP_KEY      (0xFFFFFF <<  8) // (MCI) Write Protection Key
+// -------- MCI_WPSR : (MCI Offset: 0xe8) Write Protection Status Register -------- 
+#define AT91C_MCI_WP_VS       (0xF <<  0) // (MCI) Write Protection Violation Status
+#define 	AT91C_MCI_WP_VS_NO_VIOLATION         (0x0) // (MCI) No Write Protection Violation detected since last read
+#define 	AT91C_MCI_WP_VS_ON_WRITE             (0x1) // (MCI) Write Protection Violation detected since last read
+#define 	AT91C_MCI_WP_VS_ON_RESET             (0x2) // (MCI) Software Reset Violation detected since last read
+#define 	AT91C_MCI_WP_VS_ON_BOTH              (0x3) // (MCI) Write Protection and Software Reset Violation detected since last read
+#define AT91C_MCI_WP_VSRC     (0xF <<  8) // (MCI) Write Protection Violation Source
+#define 	AT91C_MCI_WP_VSRC_NO_VIOLATION         (0x0 <<  8) // (MCI) No Write Protection Violation detected since last read
+#define 	AT91C_MCI_WP_VSRC_MCI_MR               (0x1 <<  8) // (MCI) Write Protection Violation detected on MCI_MR since last read
+#define 	AT91C_MCI_WP_VSRC_MCI_DTOR             (0x2 <<  8) // (MCI) Write Protection Violation detected on MCI_DTOR since last read
+#define 	AT91C_MCI_WP_VSRC_MCI_SDCR             (0x3 <<  8) // (MCI) Write Protection Violation detected on MCI_SDCR since last read
+#define 	AT91C_MCI_WP_VSRC_MCI_CSTOR            (0x4 <<  8) // (MCI) Write Protection Violation detected on MCI_CSTOR since last read
+#define 	AT91C_MCI_WP_VSRC_MCI_DMA              (0x5 <<  8) // (MCI) Write Protection Violation detected on MCI_DMA since last read
+#define 	AT91C_MCI_WP_VSRC_MCI_CFG              (0x6 <<  8) // (MCI) Write Protection Violation detected on MCI_CFG since last read
+#define 	AT91C_MCI_WP_VSRC_MCI_DEL              (0x7 <<  8) // (MCI) Write Protection Violation detected on MCI_DEL since last read
+// -------- MCI_VER : (MCI Offset: 0xfc)  VERSION  Register -------- 
+#define AT91C_MCI_VER         (0xF <<  0) // (MCI)  VERSION  Register
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Two-wire Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_TWI {
+	AT91_REG	 TWI_CR; 	// Control Register
+	AT91_REG	 TWI_MMR; 	// Master Mode Register
+	AT91_REG	 TWI_SMR; 	// Slave Mode Register
+	AT91_REG	 TWI_IADR; 	// Internal Address Register
+	AT91_REG	 TWI_CWGR; 	// Clock Waveform Generator Register
+	AT91_REG	 Reserved0[3]; 	// 
+	AT91_REG	 TWI_SR; 	// Status Register
+	AT91_REG	 TWI_IER; 	// Interrupt Enable Register
+	AT91_REG	 TWI_IDR; 	// Interrupt Disable Register
+	AT91_REG	 TWI_IMR; 	// Interrupt Mask Register
+	AT91_REG	 TWI_RHR; 	// Receive Holding Register
+	AT91_REG	 TWI_THR; 	// Transmit Holding Register
+	AT91_REG	 Reserved1[45]; 	// 
+	AT91_REG	 TWI_ADDRSIZE; 	// TWI ADDRSIZE REGISTER 
+	AT91_REG	 TWI_IPNAME1; 	// TWI IPNAME1 REGISTER 
+	AT91_REG	 TWI_IPNAME2; 	// TWI IPNAME2 REGISTER 
+	AT91_REG	 TWI_FEATURES; 	// TWI FEATURES REGISTER 
+	AT91_REG	 TWI_VER; 	// Version Register
+	AT91_REG	 TWI_RPR; 	// Receive Pointer Register
+	AT91_REG	 TWI_RCR; 	// Receive Counter Register
+	AT91_REG	 TWI_TPR; 	// Transmit Pointer Register
+	AT91_REG	 TWI_TCR; 	// Transmit Counter Register
+	AT91_REG	 TWI_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 TWI_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 TWI_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 TWI_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 TWI_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 TWI_PTSR; 	// PDC Transfer Status Register
+} AT91S_TWI, *AT91PS_TWI;
+#else
+#define TWI_CR          (AT91_CAST(AT91_REG *) 	0x00000000) // (TWI_CR) Control Register
+#define TWI_MMR         (AT91_CAST(AT91_REG *) 	0x00000004) // (TWI_MMR) Master Mode Register
+#define TWI_SMR         (AT91_CAST(AT91_REG *) 	0x00000008) // (TWI_SMR) Slave Mode Register
+#define TWI_IADR        (AT91_CAST(AT91_REG *) 	0x0000000C) // (TWI_IADR) Internal Address Register
+#define TWI_CWGR        (AT91_CAST(AT91_REG *) 	0x00000010) // (TWI_CWGR) Clock Waveform Generator Register
+#define TWI_SR          (AT91_CAST(AT91_REG *) 	0x00000020) // (TWI_SR) Status Register
+#define TWI_IER         (AT91_CAST(AT91_REG *) 	0x00000024) // (TWI_IER) Interrupt Enable Register
+#define TWI_IDR         (AT91_CAST(AT91_REG *) 	0x00000028) // (TWI_IDR) Interrupt Disable Register
+#define TWI_IMR         (AT91_CAST(AT91_REG *) 	0x0000002C) // (TWI_IMR) Interrupt Mask Register
+#define TWI_RHR         (AT91_CAST(AT91_REG *) 	0x00000030) // (TWI_RHR) Receive Holding Register
+#define TWI_THR         (AT91_CAST(AT91_REG *) 	0x00000034) // (TWI_THR) Transmit Holding Register
+#define TWI_ADDRSIZE    (AT91_CAST(AT91_REG *) 	0x000000EC) // (TWI_ADDRSIZE) TWI ADDRSIZE REGISTER 
+#define TWI_IPNAME1     (AT91_CAST(AT91_REG *) 	0x000000F0) // (TWI_IPNAME1) TWI IPNAME1 REGISTER 
+#define TWI_IPNAME2     (AT91_CAST(AT91_REG *) 	0x000000F4) // (TWI_IPNAME2) TWI IPNAME2 REGISTER 
+#define TWI_FEATURES    (AT91_CAST(AT91_REG *) 	0x000000F8) // (TWI_FEATURES) TWI FEATURES REGISTER 
+#define TWI_VER         (AT91_CAST(AT91_REG *) 	0x000000FC) // (TWI_VER) Version Register
+
+#endif
+// -------- TWI_CR : (TWI Offset: 0x0) TWI Control Register -------- 
+#define AT91C_TWI_START       (0x1 <<  0) // (TWI) Send a START Condition
+#define AT91C_TWI_STOP        (0x1 <<  1) // (TWI) Send a STOP Condition
+#define AT91C_TWI_MSEN        (0x1 <<  2) // (TWI) TWI Master Transfer Enabled
+#define AT91C_TWI_MSDIS       (0x1 <<  3) // (TWI) TWI Master Transfer Disabled
+#define AT91C_TWI_SVEN        (0x1 <<  4) // (TWI) TWI Slave mode Enabled
+#define AT91C_TWI_SVDIS       (0x1 <<  5) // (TWI) TWI Slave mode Disabled
+#define AT91C_TWI_SWRST       (0x1 <<  7) // (TWI) Software Reset
+// -------- TWI_MMR : (TWI Offset: 0x4) TWI Master Mode Register -------- 
+#define AT91C_TWI_IADRSZ      (0x3 <<  8) // (TWI) Internal Device Address Size
+#define 	AT91C_TWI_IADRSZ_NO                   (0x0 <<  8) // (TWI) No internal device address
+#define 	AT91C_TWI_IADRSZ_1_BYTE               (0x1 <<  8) // (TWI) One-byte internal device address
+#define 	AT91C_TWI_IADRSZ_2_BYTE               (0x2 <<  8) // (TWI) Two-byte internal device address
+#define 	AT91C_TWI_IADRSZ_3_BYTE               (0x3 <<  8) // (TWI) Three-byte internal device address
+#define AT91C_TWI_MREAD       (0x1 << 12) // (TWI) Master Read Direction
+#define AT91C_TWI_DADR        (0x7F << 16) // (TWI) Device Address
+// -------- TWI_SMR : (TWI Offset: 0x8) TWI Slave Mode Register -------- 
+#define AT91C_TWI_SADR        (0x7F << 16) // (TWI) Slave Address
+// -------- TWI_CWGR : (TWI Offset: 0x10) TWI Clock Waveform Generator Register -------- 
+#define AT91C_TWI_CLDIV       (0xFF <<  0) // (TWI) Clock Low Divider
+#define AT91C_TWI_CHDIV       (0xFF <<  8) // (TWI) Clock High Divider
+#define AT91C_TWI_CKDIV       (0x7 << 16) // (TWI) Clock Divider
+// -------- TWI_SR : (TWI Offset: 0x20) TWI Status Register -------- 
+#define AT91C_TWI_TXCOMP_SLAVE (0x1 <<  0) // (TWI) Transmission Completed
+#define AT91C_TWI_TXCOMP_MASTER (0x1 <<  0) // (TWI) Transmission Completed
+#define AT91C_TWI_RXRDY       (0x1 <<  1) // (TWI) Receive holding register ReaDY
+#define AT91C_TWI_TXRDY_MASTER (0x1 <<  2) // (TWI) Transmit holding register ReaDY
+#define AT91C_TWI_TXRDY_SLAVE (0x1 <<  2) // (TWI) Transmit holding register ReaDY
+#define AT91C_TWI_SVREAD      (0x1 <<  3) // (TWI) Slave READ (used only in Slave mode)
+#define AT91C_TWI_SVACC       (0x1 <<  4) // (TWI) Slave ACCess (used only in Slave mode)
+#define AT91C_TWI_GACC        (0x1 <<  5) // (TWI) General Call ACcess (used only in Slave mode)
+#define AT91C_TWI_OVRE        (0x1 <<  6) // (TWI) Overrun Error (used only in Master and Multi-master mode)
+#define AT91C_TWI_NACK_SLAVE  (0x1 <<  8) // (TWI) Not Acknowledged
+#define AT91C_TWI_NACK_MASTER (0x1 <<  8) // (TWI) Not Acknowledged
+#define AT91C_TWI_ARBLST_MULTI_MASTER (0x1 <<  9) // (TWI) Arbitration Lost (used only in Multimaster mode)
+#define AT91C_TWI_SCLWS       (0x1 << 10) // (TWI) Clock Wait State (used only in Slave mode)
+#define AT91C_TWI_EOSACC      (0x1 << 11) // (TWI) End Of Slave ACCess (used only in Slave mode)
+#define AT91C_TWI_ENDRX       (0x1 << 12) // (TWI) End of Receiver Transfer
+#define AT91C_TWI_ENDTX       (0x1 << 13) // (TWI) End of Receiver Transfer
+#define AT91C_TWI_RXBUFF      (0x1 << 14) // (TWI) RXBUFF Interrupt
+#define AT91C_TWI_TXBUFE      (0x1 << 15) // (TWI) TXBUFE Interrupt
+// -------- TWI_IER : (TWI Offset: 0x24) TWI Interrupt Enable Register -------- 
+// -------- TWI_IDR : (TWI Offset: 0x28) TWI Interrupt Disable Register -------- 
+// -------- TWI_IMR : (TWI Offset: 0x2c) TWI Interrupt Mask Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Usart
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_USART {
+	AT91_REG	 US_CR; 	// Control Register
+	AT91_REG	 US_MR; 	// Mode Register
+	AT91_REG	 US_IER; 	// Interrupt Enable Register
+	AT91_REG	 US_IDR; 	// Interrupt Disable Register
+	AT91_REG	 US_IMR; 	// Interrupt Mask Register
+	AT91_REG	 US_CSR; 	// Channel Status Register
+	AT91_REG	 US_RHR; 	// Receiver Holding Register
+	AT91_REG	 US_THR; 	// Transmitter Holding Register
+	AT91_REG	 US_BRGR; 	// Baud Rate Generator Register
+	AT91_REG	 US_RTOR; 	// Receiver Time-out Register
+	AT91_REG	 US_TTGR; 	// Transmitter Time-guard Register
+	AT91_REG	 Reserved0[5]; 	// 
+	AT91_REG	 US_FIDI; 	// FI_DI_Ratio Register
+	AT91_REG	 US_NER; 	// Nb Errors Register
+	AT91_REG	 Reserved1[1]; 	// 
+	AT91_REG	 US_IF; 	// IRDA_FILTER Register
+	AT91_REG	 US_MAN; 	// Manchester Encoder Decoder Register
+	AT91_REG	 Reserved2[38]; 	// 
+	AT91_REG	 US_ADDRSIZE; 	// US ADDRSIZE REGISTER 
+	AT91_REG	 US_IPNAME1; 	// US IPNAME1 REGISTER 
+	AT91_REG	 US_IPNAME2; 	// US IPNAME2 REGISTER 
+	AT91_REG	 US_FEATURES; 	// US FEATURES REGISTER 
+	AT91_REG	 US_VER; 	// VERSION Register
+	AT91_REG	 US_RPR; 	// Receive Pointer Register
+	AT91_REG	 US_RCR; 	// Receive Counter Register
+	AT91_REG	 US_TPR; 	// Transmit Pointer Register
+	AT91_REG	 US_TCR; 	// Transmit Counter Register
+	AT91_REG	 US_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 US_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 US_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 US_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 US_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 US_PTSR; 	// PDC Transfer Status Register
+} AT91S_USART, *AT91PS_USART;
+#else
+#define US_CR           (AT91_CAST(AT91_REG *) 	0x00000000) // (US_CR) Control Register
+#define US_MR           (AT91_CAST(AT91_REG *) 	0x00000004) // (US_MR) Mode Register
+#define US_IER          (AT91_CAST(AT91_REG *) 	0x00000008) // (US_IER) Interrupt Enable Register
+#define US_IDR          (AT91_CAST(AT91_REG *) 	0x0000000C) // (US_IDR) Interrupt Disable Register
+#define US_IMR          (AT91_CAST(AT91_REG *) 	0x00000010) // (US_IMR) Interrupt Mask Register
+#define US_CSR          (AT91_CAST(AT91_REG *) 	0x00000014) // (US_CSR) Channel Status Register
+#define US_RHR          (AT91_CAST(AT91_REG *) 	0x00000018) // (US_RHR) Receiver Holding Register
+#define US_THR          (AT91_CAST(AT91_REG *) 	0x0000001C) // (US_THR) Transmitter Holding Register
+#define US_BRGR         (AT91_CAST(AT91_REG *) 	0x00000020) // (US_BRGR) Baud Rate Generator Register
+#define US_RTOR         (AT91_CAST(AT91_REG *) 	0x00000024) // (US_RTOR) Receiver Time-out Register
+#define US_TTGR         (AT91_CAST(AT91_REG *) 	0x00000028) // (US_TTGR) Transmitter Time-guard Register
+#define US_FIDI         (AT91_CAST(AT91_REG *) 	0x00000040) // (US_FIDI) FI_DI_Ratio Register
+#define US_NER          (AT91_CAST(AT91_REG *) 	0x00000044) // (US_NER) Nb Errors Register
+#define US_IF           (AT91_CAST(AT91_REG *) 	0x0000004C) // (US_IF) IRDA_FILTER Register
+#define US_MAN          (AT91_CAST(AT91_REG *) 	0x00000050) // (US_MAN) Manchester Encoder Decoder Register
+#define US_ADDRSIZE     (AT91_CAST(AT91_REG *) 	0x000000EC) // (US_ADDRSIZE) US ADDRSIZE REGISTER 
+#define US_IPNAME1      (AT91_CAST(AT91_REG *) 	0x000000F0) // (US_IPNAME1) US IPNAME1 REGISTER 
+#define US_IPNAME2      (AT91_CAST(AT91_REG *) 	0x000000F4) // (US_IPNAME2) US IPNAME2 REGISTER 
+#define US_FEATURES     (AT91_CAST(AT91_REG *) 	0x000000F8) // (US_FEATURES) US FEATURES REGISTER 
+#define US_VER          (AT91_CAST(AT91_REG *) 	0x000000FC) // (US_VER) VERSION Register
+
+#endif
+// -------- US_CR : (USART Offset: 0x0)  Control Register -------- 
+#define AT91C_US_RSTRX        (0x1 <<  2) // (USART) Reset Receiver
+#define AT91C_US_RSTTX        (0x1 <<  3) // (USART) Reset Transmitter
+#define AT91C_US_RXEN         (0x1 <<  4) // (USART) Receiver Enable
+#define AT91C_US_RXDIS        (0x1 <<  5) // (USART) Receiver Disable
+#define AT91C_US_TXEN         (0x1 <<  6) // (USART) Transmitter Enable
+#define AT91C_US_TXDIS        (0x1 <<  7) // (USART) Transmitter Disable
+#define AT91C_US_RSTSTA       (0x1 <<  8) // (USART) Reset Status Bits
+#define AT91C_US_STTBRK       (0x1 <<  9) // (USART) Start Break
+#define AT91C_US_STPBRK       (0x1 << 10) // (USART) Stop Break
+#define AT91C_US_STTTO        (0x1 << 11) // (USART) Start Time-out
+#define AT91C_US_SENDA        (0x1 << 12) // (USART) Send Address
+#define AT91C_US_RSTIT        (0x1 << 13) // (USART) Reset Iterations
+#define AT91C_US_RSTNACK      (0x1 << 14) // (USART) Reset Non Acknowledge
+#define AT91C_US_RETTO        (0x1 << 15) // (USART) Rearm Time-out
+#define AT91C_US_DTREN        (0x1 << 16) // (USART) Data Terminal ready Enable
+#define AT91C_US_DTRDIS       (0x1 << 17) // (USART) Data Terminal ready Disable
+#define AT91C_US_RTSEN        (0x1 << 18) // (USART) Request to Send enable
+#define AT91C_US_RTSDIS       (0x1 << 19) // (USART) Request to Send Disable
+// -------- US_MR : (USART Offset: 0x4)  Mode Register -------- 
+#define AT91C_US_USMODE       (0xF <<  0) // (USART) Usart mode
+#define 	AT91C_US_USMODE_NORMAL               (0x0) // (USART) Normal
+#define 	AT91C_US_USMODE_RS485                (0x1) // (USART) RS485
+#define 	AT91C_US_USMODE_HWHSH                (0x2) // (USART) Hardware Handshaking
+#define 	AT91C_US_USMODE_ISO7816_0            (0x4) // (USART) ISO7816 protocol: T = 0
+#define 	AT91C_US_USMODE_ISO7816_1            (0x6) // (USART) ISO7816 protocol: T = 1
+#define 	AT91C_US_USMODE_IRDA                 (0x8) // (USART) IrDA
+#define 	AT91C_US_USMODE_SPI_MASTER           (0xE) // (USART) SPI Master
+#define 	AT91C_US_USMODE_SPI_SLAVE            (0xF) // (USART) SPI Slave
+#define AT91C_US_CLKS         (0x3 <<  4) // (USART) Clock Selection (Baud Rate generator Input Clock
+#define 	AT91C_US_CLKS_CLOCK                (0x0 <<  4) // (USART) Clock
+#define 	AT91C_US_CLKS_FDIV1                (0x1 <<  4) // (USART) fdiv1
+#define 	AT91C_US_CLKS_SLOW                 (0x2 <<  4) // (USART) slow_clock (ARM)
+#define 	AT91C_US_CLKS_EXT                  (0x3 <<  4) // (USART) External (SCK)
+#define AT91C_US_CHRL         (0x3 <<  6) // (USART) Clock Selection (Baud Rate generator Input Clock
+#define 	AT91C_US_CHRL_5_BITS               (0x0 <<  6) // (USART) Character Length: 5 bits
+#define 	AT91C_US_CHRL_6_BITS               (0x1 <<  6) // (USART) Character Length: 6 bits
+#define 	AT91C_US_CHRL_7_BITS               (0x2 <<  6) // (USART) Character Length: 7 bits
+#define 	AT91C_US_CHRL_8_BITS               (0x3 <<  6) // (USART) Character Length: 8 bits
+#define AT91C_US_SYNC         (0x1 <<  8) // (USART) Synchronous Mode Select
+#define AT91C_US_PAR          (0x7 <<  9) // (USART) Parity type
+#define 	AT91C_US_PAR_EVEN                 (0x0 <<  9) // (USART) Even Parity
+#define 	AT91C_US_PAR_ODD                  (0x1 <<  9) // (USART) Odd Parity
+#define 	AT91C_US_PAR_SPACE                (0x2 <<  9) // (USART) Parity forced to 0 (Space)
+#define 	AT91C_US_PAR_MARK                 (0x3 <<  9) // (USART) Parity forced to 1 (Mark)
+#define 	AT91C_US_PAR_NONE                 (0x4 <<  9) // (USART) No Parity
+#define 	AT91C_US_PAR_MULTI_DROP           (0x6 <<  9) // (USART) Multi-drop mode
+#define AT91C_US_NBSTOP       (0x3 << 12) // (USART) Number of Stop bits
+#define 	AT91C_US_NBSTOP_1_BIT                (0x0 << 12) // (USART) 1 stop bit
+#define 	AT91C_US_NBSTOP_15_BIT               (0x1 << 12) // (USART) Asynchronous (SYNC=0) 2 stop bits Synchronous (SYNC=1) 2 stop bits
+#define 	AT91C_US_NBSTOP_2_BIT                (0x2 << 12) // (USART) 2 stop bits
+#define AT91C_US_CHMODE       (0x3 << 14) // (USART) Channel Mode
+#define 	AT91C_US_CHMODE_NORMAL               (0x0 << 14) // (USART) Normal Mode: The USART channel operates as an RX/TX USART.
+#define 	AT91C_US_CHMODE_AUTO                 (0x1 << 14) // (USART) Automatic Echo: Receiver Data Input is connected to the TXD pin.
+#define 	AT91C_US_CHMODE_LOCAL                (0x2 << 14) // (USART) Local Loopback: Transmitter Output Signal is connected to Receiver Input Signal.
+#define 	AT91C_US_CHMODE_REMOTE               (0x3 << 14) // (USART) Remote Loopback: RXD pin is internally connected to TXD pin.
+#define AT91C_US_MSBF         (0x1 << 16) // (USART) Bit Order
+#define AT91C_US_MODE9        (0x1 << 17) // (USART) 9-bit Character length
+#define AT91C_US_CKLO         (0x1 << 18) // (USART) Clock Output Select
+#define AT91C_US_OVER         (0x1 << 19) // (USART) Over Sampling Mode
+#define AT91C_US_INACK        (0x1 << 20) // (USART) Inhibit Non Acknowledge
+#define AT91C_US_DSNACK       (0x1 << 21) // (USART) Disable Successive NACK
+#define AT91C_US_VAR_SYNC     (0x1 << 22) // (USART) Variable synchronization of command/data sync Start Frame Delimiter
+#define AT91C_US_MAX_ITER     (0x1 << 24) // (USART) Number of Repetitions
+#define AT91C_US_FILTER       (0x1 << 28) // (USART) Receive Line Filter
+#define AT91C_US_MANMODE      (0x1 << 29) // (USART) Manchester Encoder/Decoder Enable
+#define AT91C_US_MODSYNC      (0x1 << 30) // (USART) Manchester Synchronization mode
+#define AT91C_US_ONEBIT       (0x1 << 31) // (USART) Start Frame Delimiter selector
+// -------- US_IER : (USART Offset: 0x8)  Interrupt Enable Register -------- 
+#define AT91C_US_RXRDY        (0x1 <<  0) // (USART) RXRDY Interrupt
+#define AT91C_US_TXRDY        (0x1 <<  1) // (USART) TXRDY Interrupt
+#define AT91C_US_RXBRK        (0x1 <<  2) // (USART) Break Received/End of Break
+#define AT91C_US_ENDRX        (0x1 <<  3) // (USART) End of Receive Transfer Interrupt
+#define AT91C_US_ENDTX        (0x1 <<  4) // (USART) End of Transmit Interrupt
+#define AT91C_US_OVRE         (0x1 <<  5) // (USART) Overrun Interrupt
+#define AT91C_US_FRAME        (0x1 <<  6) // (USART) Framing Error Interrupt
+#define AT91C_US_PARE         (0x1 <<  7) // (USART) Parity Error Interrupt
+#define AT91C_US_TIMEOUT      (0x1 <<  8) // (USART) Receiver Time-out
+#define AT91C_US_TXEMPTY      (0x1 <<  9) // (USART) TXEMPTY Interrupt
+#define AT91C_US_ITERATION    (0x1 << 10) // (USART) Max number of Repetitions Reached
+#define AT91C_US_TXBUFE       (0x1 << 11) // (USART) TXBUFE Interrupt
+#define AT91C_US_RXBUFF       (0x1 << 12) // (USART) RXBUFF Interrupt
+#define AT91C_US_NACK         (0x1 << 13) // (USART) Non Acknowledge
+#define AT91C_US_RIIC         (0x1 << 16) // (USART) Ring INdicator Input Change Flag
+#define AT91C_US_DSRIC        (0x1 << 17) // (USART) Data Set Ready Input Change Flag
+#define AT91C_US_DCDIC        (0x1 << 18) // (USART) Data Carrier Flag
+#define AT91C_US_CTSIC        (0x1 << 19) // (USART) Clear To Send Input Change Flag
+#define AT91C_US_MANE         (0x1 << 20) // (USART) Manchester Error Interrupt
+// -------- US_IDR : (USART Offset: 0xc)  Interrupt Disable Register -------- 
+// -------- US_IMR : (USART Offset: 0x10)  Interrupt Mask Register -------- 
+// -------- US_CSR : (USART Offset: 0x14)  Channel Status Register -------- 
+#define AT91C_US_RI           (0x1 << 20) // (USART) Image of RI Input
+#define AT91C_US_DSR          (0x1 << 21) // (USART) Image of DSR Input
+#define AT91C_US_DCD          (0x1 << 22) // (USART) Image of DCD Input
+#define AT91C_US_CTS          (0x1 << 23) // (USART) Image of CTS Input
+#define AT91C_US_MANERR       (0x1 << 24) // (USART) Manchester Error
+// -------- US_MAN : (USART Offset: 0x50) Manchester Encoder Decoder Register -------- 
+#define AT91C_US_TX_PL        (0xF <<  0) // (USART) Transmitter Preamble Length
+#define AT91C_US_TX_PP        (0x3 <<  8) // (USART) Transmitter Preamble Pattern
+#define 	AT91C_US_TX_PP_ALL_ONE              (0x0 <<  8) // (USART) ALL_ONE
+#define 	AT91C_US_TX_PP_ALL_ZERO             (0x1 <<  8) // (USART) ALL_ZERO
+#define 	AT91C_US_TX_PP_ZERO_ONE             (0x2 <<  8) // (USART) ZERO_ONE
+#define 	AT91C_US_TX_PP_ONE_ZERO             (0x3 <<  8) // (USART) ONE_ZERO
+#define AT91C_US_TX_MPOL      (0x1 << 12) // (USART) Transmitter Manchester Polarity
+#define AT91C_US_RX_PL        (0xF << 16) // (USART) Receiver Preamble Length
+#define AT91C_US_RX_PP        (0x3 << 24) // (USART) Receiver Preamble Pattern detected
+#define 	AT91C_US_RX_PP_ALL_ONE              (0x0 << 24) // (USART) ALL_ONE
+#define 	AT91C_US_RX_PP_ALL_ZERO             (0x1 << 24) // (USART) ALL_ZERO
+#define 	AT91C_US_RX_PP_ZERO_ONE             (0x2 << 24) // (USART) ZERO_ONE
+#define 	AT91C_US_RX_PP_ONE_ZERO             (0x3 << 24) // (USART) ONE_ZERO
+#define AT91C_US_RX_MPOL      (0x1 << 28) // (USART) Receiver Manchester Polarity
+#define AT91C_US_DRIFT        (0x1 << 30) // (USART) Drift compensation
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Synchronous Serial Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_SSC {
+	AT91_REG	 SSC_CR; 	// Control Register
+	AT91_REG	 SSC_CMR; 	// Clock Mode Register
+	AT91_REG	 Reserved0[2]; 	// 
+	AT91_REG	 SSC_RCMR; 	// Receive Clock ModeRegister
+	AT91_REG	 SSC_RFMR; 	// Receive Frame Mode Register
+	AT91_REG	 SSC_TCMR; 	// Transmit Clock Mode Register
+	AT91_REG	 SSC_TFMR; 	// Transmit Frame Mode Register
+	AT91_REG	 SSC_RHR; 	// Receive Holding Register
+	AT91_REG	 SSC_THR; 	// Transmit Holding Register
+	AT91_REG	 Reserved1[2]; 	// 
+	AT91_REG	 SSC_RSHR; 	// Receive Sync Holding Register
+	AT91_REG	 SSC_TSHR; 	// Transmit Sync Holding Register
+	AT91_REG	 Reserved2[2]; 	// 
+	AT91_REG	 SSC_SR; 	// Status Register
+	AT91_REG	 SSC_IER; 	// Interrupt Enable Register
+	AT91_REG	 SSC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 SSC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 Reserved3[39]; 	// 
+	AT91_REG	 SSC_ADDRSIZE; 	// SSC ADDRSIZE REGISTER 
+	AT91_REG	 SSC_IPNAME1; 	// SSC IPNAME1 REGISTER 
+	AT91_REG	 SSC_IPNAME2; 	// SSC IPNAME2 REGISTER 
+	AT91_REG	 SSC_FEATURES; 	// SSC FEATURES REGISTER 
+	AT91_REG	 SSC_VER; 	// Version Register
+	AT91_REG	 SSC_RPR; 	// Receive Pointer Register
+	AT91_REG	 SSC_RCR; 	// Receive Counter Register
+	AT91_REG	 SSC_TPR; 	// Transmit Pointer Register
+	AT91_REG	 SSC_TCR; 	// Transmit Counter Register
+	AT91_REG	 SSC_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 SSC_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 SSC_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 SSC_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 SSC_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 SSC_PTSR; 	// PDC Transfer Status Register
+} AT91S_SSC, *AT91PS_SSC;
+#else
+#define SSC_CR          (AT91_CAST(AT91_REG *) 	0x00000000) // (SSC_CR) Control Register
+#define SSC_CMR         (AT91_CAST(AT91_REG *) 	0x00000004) // (SSC_CMR) Clock Mode Register
+#define SSC_RCMR        (AT91_CAST(AT91_REG *) 	0x00000010) // (SSC_RCMR) Receive Clock ModeRegister
+#define SSC_RFMR        (AT91_CAST(AT91_REG *) 	0x00000014) // (SSC_RFMR) Receive Frame Mode Register
+#define SSC_TCMR        (AT91_CAST(AT91_REG *) 	0x00000018) // (SSC_TCMR) Transmit Clock Mode Register
+#define SSC_TFMR        (AT91_CAST(AT91_REG *) 	0x0000001C) // (SSC_TFMR) Transmit Frame Mode Register
+#define SSC_RHR         (AT91_CAST(AT91_REG *) 	0x00000020) // (SSC_RHR) Receive Holding Register
+#define SSC_THR         (AT91_CAST(AT91_REG *) 	0x00000024) // (SSC_THR) Transmit Holding Register
+#define SSC_RSHR        (AT91_CAST(AT91_REG *) 	0x00000030) // (SSC_RSHR) Receive Sync Holding Register
+#define SSC_TSHR        (AT91_CAST(AT91_REG *) 	0x00000034) // (SSC_TSHR) Transmit Sync Holding Register
+#define SSC_SR          (AT91_CAST(AT91_REG *) 	0x00000040) // (SSC_SR) Status Register
+#define SSC_IER         (AT91_CAST(AT91_REG *) 	0x00000044) // (SSC_IER) Interrupt Enable Register
+#define SSC_IDR         (AT91_CAST(AT91_REG *) 	0x00000048) // (SSC_IDR) Interrupt Disable Register
+#define SSC_IMR         (AT91_CAST(AT91_REG *) 	0x0000004C) // (SSC_IMR) Interrupt Mask Register
+#define SSC_ADDRSIZE    (AT91_CAST(AT91_REG *) 	0x000000EC) // (SSC_ADDRSIZE) SSC ADDRSIZE REGISTER 
+#define SSC_IPNAME1     (AT91_CAST(AT91_REG *) 	0x000000F0) // (SSC_IPNAME1) SSC IPNAME1 REGISTER 
+#define SSC_IPNAME2     (AT91_CAST(AT91_REG *) 	0x000000F4) // (SSC_IPNAME2) SSC IPNAME2 REGISTER 
+#define SSC_FEATURES    (AT91_CAST(AT91_REG *) 	0x000000F8) // (SSC_FEATURES) SSC FEATURES REGISTER 
+#define SSC_VER         (AT91_CAST(AT91_REG *) 	0x000000FC) // (SSC_VER) Version Register
+
+#endif
+// -------- SSC_CR : (SSC Offset: 0x0) SSC Control Register -------- 
+#define AT91C_SSC_RXEN        (0x1 <<  0) // (SSC) Receive Enable
+#define AT91C_SSC_RXDIS       (0x1 <<  1) // (SSC) Receive Disable
+#define AT91C_SSC_TXEN        (0x1 <<  8) // (SSC) Transmit Enable
+#define AT91C_SSC_TXDIS       (0x1 <<  9) // (SSC) Transmit Disable
+#define AT91C_SSC_SWRST       (0x1 << 15) // (SSC) Software Reset
+// -------- SSC_RCMR : (SSC Offset: 0x10) SSC Receive Clock Mode Register -------- 
+#define AT91C_SSC_CKS         (0x3 <<  0) // (SSC) Receive/Transmit Clock Selection
+#define 	AT91C_SSC_CKS_DIV                  (0x0) // (SSC) Divided Clock
+#define 	AT91C_SSC_CKS_TK                   (0x1) // (SSC) TK Clock signal
+#define 	AT91C_SSC_CKS_RK                   (0x2) // (SSC) RK pin
+#define AT91C_SSC_CKO         (0x7 <<  2) // (SSC) Receive/Transmit Clock Output Mode Selection
+#define 	AT91C_SSC_CKO_NONE                 (0x0 <<  2) // (SSC) Receive/Transmit Clock Output Mode: None RK pin: Input-only
+#define 	AT91C_SSC_CKO_CONTINOUS            (0x1 <<  2) // (SSC) Continuous Receive/Transmit Clock RK pin: Output
+#define 	AT91C_SSC_CKO_DATA_TX              (0x2 <<  2) // (SSC) Receive/Transmit Clock only during data transfers RK pin: Output
+#define AT91C_SSC_CKI         (0x1 <<  5) // (SSC) Receive/Transmit Clock Inversion
+#define AT91C_SSC_CKG         (0x3 <<  6) // (SSC) Receive/Transmit Clock Gating Selection
+#define 	AT91C_SSC_CKG_NONE                 (0x0 <<  6) // (SSC) Receive/Transmit Clock Gating: None, continuous clock
+#define 	AT91C_SSC_CKG_LOW                  (0x1 <<  6) // (SSC) Receive/Transmit Clock enabled only if RF Low
+#define 	AT91C_SSC_CKG_HIGH                 (0x2 <<  6) // (SSC) Receive/Transmit Clock enabled only if RF High
+#define AT91C_SSC_START       (0xF <<  8) // (SSC) Receive/Transmit Start Selection
+#define 	AT91C_SSC_START_CONTINOUS            (0x0 <<  8) // (SSC) Continuous, as soon as the receiver is enabled, and immediately after the end of transfer of the previous data.
+#define 	AT91C_SSC_START_TX                   (0x1 <<  8) // (SSC) Transmit/Receive start
+#define 	AT91C_SSC_START_LOW_RF               (0x2 <<  8) // (SSC) Detection of a low level on RF input
+#define 	AT91C_SSC_START_HIGH_RF              (0x3 <<  8) // (SSC) Detection of a high level on RF input
+#define 	AT91C_SSC_START_FALL_RF              (0x4 <<  8) // (SSC) Detection of a falling edge on RF input
+#define 	AT91C_SSC_START_RISE_RF              (0x5 <<  8) // (SSC) Detection of a rising edge on RF input
+#define 	AT91C_SSC_START_LEVEL_RF             (0x6 <<  8) // (SSC) Detection of any level change on RF input
+#define 	AT91C_SSC_START_EDGE_RF              (0x7 <<  8) // (SSC) Detection of any edge on RF input
+#define 	AT91C_SSC_START_0                    (0x8 <<  8) // (SSC) Compare 0
+#define AT91C_SSC_STOP        (0x1 << 12) // (SSC) Receive Stop Selection
+#define AT91C_SSC_STTDLY      (0xFF << 16) // (SSC) Receive/Transmit Start Delay
+#define AT91C_SSC_PERIOD      (0xFF << 24) // (SSC) Receive/Transmit Period Divider Selection
+// -------- SSC_RFMR : (SSC Offset: 0x14) SSC Receive Frame Mode Register -------- 
+#define AT91C_SSC_DATLEN      (0x1F <<  0) // (SSC) Data Length
+#define AT91C_SSC_LOOP        (0x1 <<  5) // (SSC) Loop Mode
+#define AT91C_SSC_MSBF        (0x1 <<  7) // (SSC) Most Significant Bit First
+#define AT91C_SSC_DATNB       (0xF <<  8) // (SSC) Data Number per Frame
+#define AT91C_SSC_FSLEN       (0xF << 16) // (SSC) Receive/Transmit Frame Sync length
+#define AT91C_SSC_FSOS        (0x7 << 20) // (SSC) Receive/Transmit Frame Sync Output Selection
+#define 	AT91C_SSC_FSOS_NONE                 (0x0 << 20) // (SSC) Selected Receive/Transmit Frame Sync Signal: None RK pin Input-only
+#define 	AT91C_SSC_FSOS_NEGATIVE             (0x1 << 20) // (SSC) Selected Receive/Transmit Frame Sync Signal: Negative Pulse
+#define 	AT91C_SSC_FSOS_POSITIVE             (0x2 << 20) // (SSC) Selected Receive/Transmit Frame Sync Signal: Positive Pulse
+#define 	AT91C_SSC_FSOS_LOW                  (0x3 << 20) // (SSC) Selected Receive/Transmit Frame Sync Signal: Driver Low during data transfer
+#define 	AT91C_SSC_FSOS_HIGH                 (0x4 << 20) // (SSC) Selected Receive/Transmit Frame Sync Signal: Driver High during data transfer
+#define 	AT91C_SSC_FSOS_TOGGLE               (0x5 << 20) // (SSC) Selected Receive/Transmit Frame Sync Signal: Toggling at each start of data transfer
+#define AT91C_SSC_FSEDGE      (0x1 << 24) // (SSC) Frame Sync Edge Detection
+// -------- SSC_TCMR : (SSC Offset: 0x18) SSC Transmit Clock Mode Register -------- 
+// -------- SSC_TFMR : (SSC Offset: 0x1c) SSC Transmit Frame Mode Register -------- 
+#define AT91C_SSC_DATDEF      (0x1 <<  5) // (SSC) Data Default Value
+#define AT91C_SSC_FSDEN       (0x1 << 23) // (SSC) Frame Sync Data Enable
+// -------- SSC_SR : (SSC Offset: 0x40) SSC Status Register -------- 
+#define AT91C_SSC_TXRDY       (0x1 <<  0) // (SSC) Transmit Ready
+#define AT91C_SSC_TXEMPTY     (0x1 <<  1) // (SSC) Transmit Empty
+#define AT91C_SSC_ENDTX       (0x1 <<  2) // (SSC) End Of Transmission
+#define AT91C_SSC_TXBUFE      (0x1 <<  3) // (SSC) Transmit Buffer Empty
+#define AT91C_SSC_RXRDY       (0x1 <<  4) // (SSC) Receive Ready
+#define AT91C_SSC_OVRUN       (0x1 <<  5) // (SSC) Receive Overrun
+#define AT91C_SSC_ENDRX       (0x1 <<  6) // (SSC) End of Reception
+#define AT91C_SSC_RXBUFF      (0x1 <<  7) // (SSC) Receive Buffer Full
+#define AT91C_SSC_CP0         (0x1 <<  8) // (SSC) Compare 0
+#define AT91C_SSC_CP1         (0x1 <<  9) // (SSC) Compare 1
+#define AT91C_SSC_TXSYN       (0x1 << 10) // (SSC) Transmit Sync
+#define AT91C_SSC_RXSYN       (0x1 << 11) // (SSC) Receive Sync
+#define AT91C_SSC_TXENA       (0x1 << 16) // (SSC) Transmit Enable
+#define AT91C_SSC_RXENA       (0x1 << 17) // (SSC) Receive Enable
+// -------- SSC_IER : (SSC Offset: 0x44) SSC Interrupt Enable Register -------- 
+// -------- SSC_IDR : (SSC Offset: 0x48) SSC Interrupt Disable Register -------- 
+// -------- SSC_IMR : (SSC Offset: 0x4c) SSC Interrupt Mask Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR PWMC Channel Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_PWMC_CH {
+	AT91_REG	 PWMC_CMR; 	// Channel Mode Register
+	AT91_REG	 PWMC_CDTYR; 	// Channel Duty Cycle Register
+	AT91_REG	 PWMC_CPRDR; 	// Channel Period Register
+	AT91_REG	 PWMC_CCNTR; 	// Channel Counter Register
+	AT91_REG	 PWMC_CUPDR; 	// Channel Update Register
+	AT91_REG	 PWMC_Reserved[3]; 	// Reserved
+} AT91S_PWMC_CH, *AT91PS_PWMC_CH;
+#else
+#define PWMC_CMR        (AT91_CAST(AT91_REG *) 	0x00000000) // (PWMC_CMR) Channel Mode Register
+#define PWMC_CDTYR      (AT91_CAST(AT91_REG *) 	0x00000004) // (PWMC_CDTYR) Channel Duty Cycle Register
+#define PWMC_CPRDR      (AT91_CAST(AT91_REG *) 	0x00000008) // (PWMC_CPRDR) Channel Period Register
+#define PWMC_CCNTR      (AT91_CAST(AT91_REG *) 	0x0000000C) // (PWMC_CCNTR) Channel Counter Register
+#define PWMC_CUPDR      (AT91_CAST(AT91_REG *) 	0x00000010) // (PWMC_CUPDR) Channel Update Register
+#define Reserved        (AT91_CAST(AT91_REG *) 	0x00000014) // (Reserved) Reserved
+
+#endif
+// -------- PWMC_CMR : (PWMC_CH Offset: 0x0) PWMC Channel Mode Register -------- 
+#define AT91C_PWMC_CPRE       (0xF <<  0) // (PWMC_CH) Channel Pre-scaler : PWMC_CLKx
+#define 	AT91C_PWMC_CPRE_MCK                  (0x0) // (PWMC_CH) 
+#define 	AT91C_PWMC_CPRE_MCKA                 (0xB) // (PWMC_CH) 
+#define 	AT91C_PWMC_CPRE_MCKB                 (0xC) // (PWMC_CH) 
+#define AT91C_PWMC_CALG       (0x1 <<  8) // (PWMC_CH) Channel Alignment
+#define AT91C_PWMC_CPOL       (0x1 <<  9) // (PWMC_CH) Channel Polarity
+#define AT91C_PWMC_CPD        (0x1 << 10) // (PWMC_CH) Channel Update Period
+// -------- PWMC_CDTYR : (PWMC_CH Offset: 0x4) PWMC Channel Duty Cycle Register -------- 
+#define AT91C_PWMC_CDTY       (0x0 <<  0) // (PWMC_CH) Channel Duty Cycle
+// -------- PWMC_CPRDR : (PWMC_CH Offset: 0x8) PWMC Channel Period Register -------- 
+#define AT91C_PWMC_CPRD       (0x0 <<  0) // (PWMC_CH) Channel Period
+// -------- PWMC_CCNTR : (PWMC_CH Offset: 0xc) PWMC Channel Counter Register -------- 
+#define AT91C_PWMC_CCNT       (0x0 <<  0) // (PWMC_CH) Channel Counter
+// -------- PWMC_CUPDR : (PWMC_CH Offset: 0x10) PWMC Channel Update Register -------- 
+#define AT91C_PWMC_CUPD       (0x0 <<  0) // (PWMC_CH) Channel Update
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Pulse Width Modulation Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_PWMC {
+	AT91_REG	 PWMC_MR; 	// PWMC Mode Register
+	AT91_REG	 PWMC_ENA; 	// PWMC Enable Register
+	AT91_REG	 PWMC_DIS; 	// PWMC Disable Register
+	AT91_REG	 PWMC_SR; 	// PWMC Status Register
+	AT91_REG	 PWMC_IER; 	// PWMC Interrupt Enable Register
+	AT91_REG	 PWMC_IDR; 	// PWMC Interrupt Disable Register
+	AT91_REG	 PWMC_IMR; 	// PWMC Interrupt Mask Register
+	AT91_REG	 PWMC_ISR; 	// PWMC Interrupt Status Register
+	AT91_REG	 Reserved0[55]; 	// 
+	AT91_REG	 PWMC_VR; 	// PWMC Version Register
+	AT91_REG	 Reserved1[64]; 	// 
+	AT91S_PWMC_CH	 PWMC_CH[32]; 	// PWMC Channel
+} AT91S_PWMC, *AT91PS_PWMC;
+#else
+#define PWMC_MR         (AT91_CAST(AT91_REG *) 	0x00000000) // (PWMC_MR) PWMC Mode Register
+#define PWMC_ENA        (AT91_CAST(AT91_REG *) 	0x00000004) // (PWMC_ENA) PWMC Enable Register
+#define PWMC_DIS        (AT91_CAST(AT91_REG *) 	0x00000008) // (PWMC_DIS) PWMC Disable Register
+#define PWMC_SR         (AT91_CAST(AT91_REG *) 	0x0000000C) // (PWMC_SR) PWMC Status Register
+#define PWMC_IER        (AT91_CAST(AT91_REG *) 	0x00000010) // (PWMC_IER) PWMC Interrupt Enable Register
+#define PWMC_IDR        (AT91_CAST(AT91_REG *) 	0x00000014) // (PWMC_IDR) PWMC Interrupt Disable Register
+#define PWMC_IMR        (AT91_CAST(AT91_REG *) 	0x00000018) // (PWMC_IMR) PWMC Interrupt Mask Register
+#define PWMC_ISR        (AT91_CAST(AT91_REG *) 	0x0000001C) // (PWMC_ISR) PWMC Interrupt Status Register
+#define PWMC_VR         (AT91_CAST(AT91_REG *) 	0x000000FC) // (PWMC_VR) PWMC Version Register
+
+#endif
+// -------- PWMC_MR : (PWMC Offset: 0x0) PWMC Mode Register -------- 
+#define AT91C_PWMC_DIVA       (0xFF <<  0) // (PWMC) CLKA divide factor.
+#define AT91C_PWMC_PREA       (0xF <<  8) // (PWMC) Divider Input Clock Prescaler A
+#define 	AT91C_PWMC_PREA_MCK                  (0x0 <<  8) // (PWMC) 
+#define AT91C_PWMC_DIVB       (0xFF << 16) // (PWMC) CLKB divide factor.
+#define AT91C_PWMC_PREB       (0xF << 24) // (PWMC) Divider Input Clock Prescaler B
+#define 	AT91C_PWMC_PREB_MCK                  (0x0 << 24) // (PWMC) 
+// -------- PWMC_ENA : (PWMC Offset: 0x4) PWMC Enable Register -------- 
+#define AT91C_PWMC_CHID0      (0x1 <<  0) // (PWMC) Channel ID 0
+#define AT91C_PWMC_CHID1      (0x1 <<  1) // (PWMC) Channel ID 1
+#define AT91C_PWMC_CHID2      (0x1 <<  2) // (PWMC) Channel ID 2
+#define AT91C_PWMC_CHID3      (0x1 <<  3) // (PWMC) Channel ID 3
+#define AT91C_PWMC_CHID4      (0x1 <<  4) // (PWMC) Channel ID 4
+#define AT91C_PWMC_CHID5      (0x1 <<  5) // (PWMC) Channel ID 5
+#define AT91C_PWMC_CHID6      (0x1 <<  6) // (PWMC) Channel ID 6
+#define AT91C_PWMC_CHID7      (0x1 <<  7) // (PWMC) Channel ID 7
+// -------- PWMC_DIS : (PWMC Offset: 0x8) PWMC Disable Register -------- 
+// -------- PWMC_SR : (PWMC Offset: 0xc) PWMC Status Register -------- 
+// -------- PWMC_IER : (PWMC Offset: 0x10) PWMC Interrupt Enable Register -------- 
+// -------- PWMC_IDR : (PWMC Offset: 0x14) PWMC Interrupt Disable Register -------- 
+// -------- PWMC_IMR : (PWMC Offset: 0x18) PWMC Interrupt Mask Register -------- 
+// -------- PWMC_ISR : (PWMC Offset: 0x1c) PWMC Interrupt Status Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Serial Parallel Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_SPI {
+	AT91_REG	 SPI_CR; 	// Control Register
+	AT91_REG	 SPI_MR; 	// Mode Register
+	AT91_REG	 SPI_RDR; 	// Receive Data Register
+	AT91_REG	 SPI_TDR; 	// Transmit Data Register
+	AT91_REG	 SPI_SR; 	// Status Register
+	AT91_REG	 SPI_IER; 	// Interrupt Enable Register
+	AT91_REG	 SPI_IDR; 	// Interrupt Disable Register
+	AT91_REG	 SPI_IMR; 	// Interrupt Mask Register
+	AT91_REG	 Reserved0[4]; 	// 
+	AT91_REG	 SPI_CSR[4]; 	// Chip Select Register
+	AT91_REG	 Reserved1[48]; 	// 
+	AT91_REG	 SPI_RPR; 	// Receive Pointer Register
+	AT91_REG	 SPI_RCR; 	// Receive Counter Register
+	AT91_REG	 SPI_TPR; 	// Transmit Pointer Register
+	AT91_REG	 SPI_TCR; 	// Transmit Counter Register
+	AT91_REG	 SPI_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 SPI_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 SPI_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 SPI_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 SPI_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 SPI_PTSR; 	// PDC Transfer Status Register
+} AT91S_SPI, *AT91PS_SPI;
+#else
+#define SPI_CR          (AT91_CAST(AT91_REG *) 	0x00000000) // (SPI_CR) Control Register
+#define SPI_MR          (AT91_CAST(AT91_REG *) 	0x00000004) // (SPI_MR) Mode Register
+#define SPI_RDR         (AT91_CAST(AT91_REG *) 	0x00000008) // (SPI_RDR) Receive Data Register
+#define SPI_TDR         (AT91_CAST(AT91_REG *) 	0x0000000C) // (SPI_TDR) Transmit Data Register
+#define SPI_SR          (AT91_CAST(AT91_REG *) 	0x00000010) // (SPI_SR) Status Register
+#define SPI_IER         (AT91_CAST(AT91_REG *) 	0x00000014) // (SPI_IER) Interrupt Enable Register
+#define SPI_IDR         (AT91_CAST(AT91_REG *) 	0x00000018) // (SPI_IDR) Interrupt Disable Register
+#define SPI_IMR         (AT91_CAST(AT91_REG *) 	0x0000001C) // (SPI_IMR) Interrupt Mask Register
+#define SPI_CSR         (AT91_CAST(AT91_REG *) 	0x00000030) // (SPI_CSR) Chip Select Register
+
+#endif
+// -------- SPI_CR : (SPI Offset: 0x0) SPI Control Register -------- 
+#define AT91C_SPI_SPIEN       (0x1 <<  0) // (SPI) SPI Enable
+#define AT91C_SPI_SPIDIS      (0x1 <<  1) // (SPI) SPI Disable
+#define AT91C_SPI_SWRST       (0x1 <<  7) // (SPI) SPI Software reset
+#define AT91C_SPI_LASTXFER    (0x1 << 24) // (SPI) SPI Last Transfer
+// -------- SPI_MR : (SPI Offset: 0x4) SPI Mode Register -------- 
+#define AT91C_SPI_MSTR        (0x1 <<  0) // (SPI) Master/Slave Mode
+#define AT91C_SPI_PS          (0x1 <<  1) // (SPI) Peripheral Select
+#define 	AT91C_SPI_PS_FIXED                (0x0 <<  1) // (SPI) Fixed Peripheral Select
+#define 	AT91C_SPI_PS_VARIABLE             (0x1 <<  1) // (SPI) Variable Peripheral Select
+#define AT91C_SPI_PCSDEC      (0x1 <<  2) // (SPI) Chip Select Decode
+#define AT91C_SPI_FDIV        (0x1 <<  3) // (SPI) Clock Selection
+#define AT91C_SPI_MODFDIS     (0x1 <<  4) // (SPI) Mode Fault Detection
+#define AT91C_SPI_LLB         (0x1 <<  7) // (SPI) Clock Selection
+#define AT91C_SPI_PCS         (0xF << 16) // (SPI) Peripheral Chip Select
+#define AT91C_SPI_DLYBCS      (0xFF << 24) // (SPI) Delay Between Chip Selects
+// -------- SPI_RDR : (SPI Offset: 0x8) Receive Data Register -------- 
+#define AT91C_SPI_RD          (0xFFFF <<  0) // (SPI) Receive Data
+#define AT91C_SPI_RPCS        (0xF << 16) // (SPI) Peripheral Chip Select Status
+// -------- SPI_TDR : (SPI Offset: 0xc) Transmit Data Register -------- 
+#define AT91C_SPI_TD          (0xFFFF <<  0) // (SPI) Transmit Data
+#define AT91C_SPI_TPCS        (0xF << 16) // (SPI) Peripheral Chip Select Status
+// -------- SPI_SR : (SPI Offset: 0x10) Status Register -------- 
+#define AT91C_SPI_RDRF        (0x1 <<  0) // (SPI) Receive Data Register Full
+#define AT91C_SPI_TDRE        (0x1 <<  1) // (SPI) Transmit Data Register Empty
+#define AT91C_SPI_MODF        (0x1 <<  2) // (SPI) Mode Fault Error
+#define AT91C_SPI_OVRES       (0x1 <<  3) // (SPI) Overrun Error Status
+#define AT91C_SPI_ENDRX       (0x1 <<  4) // (SPI) End of Receiver Transfer
+#define AT91C_SPI_ENDTX       (0x1 <<  5) // (SPI) End of Receiver Transfer
+#define AT91C_SPI_RXBUFF      (0x1 <<  6) // (SPI) RXBUFF Interrupt
+#define AT91C_SPI_TXBUFE      (0x1 <<  7) // (SPI) TXBUFE Interrupt
+#define AT91C_SPI_NSSR        (0x1 <<  8) // (SPI) NSSR Interrupt
+#define AT91C_SPI_TXEMPTY     (0x1 <<  9) // (SPI) TXEMPTY Interrupt
+#define AT91C_SPI_SPIENS      (0x1 << 16) // (SPI) Enable Status
+// -------- SPI_IER : (SPI Offset: 0x14) Interrupt Enable Register -------- 
+// -------- SPI_IDR : (SPI Offset: 0x18) Interrupt Disable Register -------- 
+// -------- SPI_IMR : (SPI Offset: 0x1c) Interrupt Mask Register -------- 
+// -------- SPI_CSR : (SPI Offset: 0x30) Chip Select Register -------- 
+#define AT91C_SPI_CPOL        (0x1 <<  0) // (SPI) Clock Polarity
+#define AT91C_SPI_NCPHA       (0x1 <<  1) // (SPI) Clock Phase
+#define AT91C_SPI_CSAAT       (0x1 <<  3) // (SPI) Chip Select Active After Transfer
+#define AT91C_SPI_BITS        (0xF <<  4) // (SPI) Bits Per Transfer
+#define 	AT91C_SPI_BITS_8                    (0x0 <<  4) // (SPI) 8 Bits Per transfer
+#define 	AT91C_SPI_BITS_9                    (0x1 <<  4) // (SPI) 9 Bits Per transfer
+#define 	AT91C_SPI_BITS_10                   (0x2 <<  4) // (SPI) 10 Bits Per transfer
+#define 	AT91C_SPI_BITS_11                   (0x3 <<  4) // (SPI) 11 Bits Per transfer
+#define 	AT91C_SPI_BITS_12                   (0x4 <<  4) // (SPI) 12 Bits Per transfer
+#define 	AT91C_SPI_BITS_13                   (0x5 <<  4) // (SPI) 13 Bits Per transfer
+#define 	AT91C_SPI_BITS_14                   (0x6 <<  4) // (SPI) 14 Bits Per transfer
+#define 	AT91C_SPI_BITS_15                   (0x7 <<  4) // (SPI) 15 Bits Per transfer
+#define 	AT91C_SPI_BITS_16                   (0x8 <<  4) // (SPI) 16 Bits Per transfer
+#define AT91C_SPI_SCBR        (0xFF <<  8) // (SPI) Serial Clock Baud Rate
+#define AT91C_SPI_DLYBS       (0xFF << 16) // (SPI) Delay Before SPCK
+#define AT91C_SPI_DLYBCT      (0xFF << 24) // (SPI) Delay Between Consecutive Transfers
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR TSADC
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_TSADC {
+	AT91_REG	 TSADC_CR; 	// Control Register
+	AT91_REG	 TSADC_MR; 	// Mode Register
+	AT91_REG	 TSADC_TRGR; 	// Trigger Register
+	AT91_REG	 TSADC_TSR; 	// Touch Screen Register
+	AT91_REG	 TSADC_CHER; 	// Channel Enable Register
+	AT91_REG	 TSADC_CHDR; 	// Channel Disable Register
+	AT91_REG	 TSADC_CHSR; 	// Channel Status Register
+	AT91_REG	 TSADC_SR; 	// Status Register
+	AT91_REG	 TSADC_LCDR; 	// Last Converted Register
+	AT91_REG	 TSADC_IER; 	// Interrupt Enable Register
+	AT91_REG	 TSADC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 TSADC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 TSADC_CDR0; 	// Channel Data Register 0
+	AT91_REG	 TSADC_CDR1; 	// Channel Data Register 1
+	AT91_REG	 TSADC_CDR2; 	// Channel Data Register 2
+	AT91_REG	 TSADC_CDR3; 	// Channel Data Register 3
+	AT91_REG	 TSADC_CDR4; 	// Channel Data Register 4
+	AT91_REG	 TSADC_CDR5; 	// Channel Data Register 5
+	AT91_REG	 TSADC_CDR6; 	// Channel Data Register 6
+	AT91_REG	 TSADC_CDR7; 	// Channel Data Register 7
+	AT91_REG	 Reserved0[44]; 	// 
+	AT91_REG	 TSADC_RPR; 	// Receive Pointer Register
+	AT91_REG	 TSADC_RCR; 	// Receive Counter Register
+	AT91_REG	 TSADC_TPR; 	// Transmit Pointer Register
+	AT91_REG	 TSADC_TCR; 	// Transmit Counter Register
+	AT91_REG	 TSADC_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 TSADC_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 TSADC_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 TSADC_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 TSADC_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 TSADC_PTSR; 	// PDC Transfer Status Register
+} AT91S_TSADC, *AT91PS_TSADC;
+#else
+#define TSADC_CR        (AT91_CAST(AT91_REG *) 	0x00000000) // (TSADC_CR) Control Register
+#define TSADC_MR        (AT91_CAST(AT91_REG *) 	0x00000004) // (TSADC_MR) Mode Register
+#define TSADC_TRGR      (AT91_CAST(AT91_REG *) 	0x00000008) // (TSADC_TRGR) Trigger Register
+#define TSADC_TSR       (AT91_CAST(AT91_REG *) 	0x0000000C) // (TSADC_TSR) Touch Screen Register
+#define TSADC_CHER      (AT91_CAST(AT91_REG *) 	0x00000010) // (TSADC_CHER) Channel Enable Register
+#define TSADC_CHDR      (AT91_CAST(AT91_REG *) 	0x00000014) // (TSADC_CHDR) Channel Disable Register
+#define TSADC_CHSR      (AT91_CAST(AT91_REG *) 	0x00000018) // (TSADC_CHSR) Channel Status Register
+#define TSADC_SR        (AT91_CAST(AT91_REG *) 	0x0000001C) // (TSADC_SR) Status Register
+#define TSADC_LCDR      (AT91_CAST(AT91_REG *) 	0x00000020) // (TSADC_LCDR) Last Converted Register
+#define TSADC_IER       (AT91_CAST(AT91_REG *) 	0x00000024) // (TSADC_IER) Interrupt Enable Register
+#define TSADC_IDR       (AT91_CAST(AT91_REG *) 	0x00000028) // (TSADC_IDR) Interrupt Disable Register
+#define TSADC_IMR       (AT91_CAST(AT91_REG *) 	0x0000002C) // (TSADC_IMR) Interrupt Mask Register
+#define TSADC_CDR0      (AT91_CAST(AT91_REG *) 	0x00000030) // (TSADC_CDR0) Channel Data Register 0
+#define TSADC_CDR1      (AT91_CAST(AT91_REG *) 	0x00000034) // (TSADC_CDR1) Channel Data Register 1
+#define TSADC_CDR2      (AT91_CAST(AT91_REG *) 	0x00000038) // (TSADC_CDR2) Channel Data Register 2
+#define TSADC_CDR3      (AT91_CAST(AT91_REG *) 	0x0000003C) // (TSADC_CDR3) Channel Data Register 3
+#define TSADC_CDR4      (AT91_CAST(AT91_REG *) 	0x00000040) // (TSADC_CDR4) Channel Data Register 4
+#define TSADC_CDR5      (AT91_CAST(AT91_REG *) 	0x00000044) // (TSADC_CDR5) Channel Data Register 5
+#define TSADC_CDR6      (AT91_CAST(AT91_REG *) 	0x00000048) // (TSADC_CDR6) Channel Data Register 6
+#define TSADC_CDR7      (AT91_CAST(AT91_REG *) 	0x0000004C) // (TSADC_CDR7) Channel Data Register 7
+
+#endif
+// -------- TSADC_CR : (TSADC Offset: 0x0) Control Register -------- 
+#define AT91C_TSADC_SWRST     (0x1 <<  0) // (TSADC) Software Reset
+#define AT91C_TSADC_START     (0x1 <<  1) // (TSADC) Start Conversion
+// -------- TSADC_MR : (TSADC Offset: 0x4) Mode Register -------- 
+#define AT91C_TSADC_TSAMOD    (0x3 <<  0) // (TSADC) Touch Screen ADC Mode
+#define 	AT91C_TSADC_TSAMOD_ADC_ONLY_MODE        (0x0) // (TSADC) ADC Mode
+#define 	AT91C_TSADC_TSAMOD_TS_ONLY_MODE         (0x1) // (TSADC) Touch Screen Only Mode
+#define AT91C_TSADC_LOWRES    (0x1 <<  4) // (TSADC) ADC Resolution
+#define AT91C_TSADC_SLEEP     (0x1 <<  5) // (TSADC) Sleep Mode
+#define AT91C_TSADC_PENDET    (0x1 <<  6) // (TSADC) Pen Detect Selection
+#define AT91C_TSADC_PRESCAL   (0xFF <<  8) // (TSADC) Prescaler Rate Selection
+#define AT91C_TSADC_STARTUP   (0x7F << 16) // (TSADC) Startup Time
+#define AT91C_TSADC_SHTIM     (0xF << 24) // (TSADC) Sample and Hold Time for ADC Channels
+#define AT91C_TSADC_PENDBC    (0xF << 28) // (TSADC) Pen Detect Debouncing Period
+// -------- TSADC_TRGR : (TSADC Offset: 0x8) Trigger Register -------- 
+#define AT91C_TSADC_TRGMOD    (0x7 <<  0) // (TSADC) Trigger Mode
+#define 	AT91C_TSADC_TRGMOD_NO_TRIGGER           (0x0) // (TSADC) No Trigger
+#define 	AT91C_TSADC_TRGMOD_EXTERNAL_TRIGGER_RE  (0x1) // (TSADC) External Trigger Rising Edge
+#define 	AT91C_TSADC_TRGMOD_EXTERNAL_TRIGGER_FE  (0x2) // (TSADC) External Trigger Falling Edge
+#define 	AT91C_TSADC_TRGMOD_EXTERNAL_TRIGGER_AE  (0x3) // (TSADC) External Trigger Any Edge
+#define 	AT91C_TSADC_TRGMOD_PENDET_TRIGGER       (0x4) // (TSADC) Pen Detect Trigger (only if PENDET is set and in Touch Screen mode only)
+#define 	AT91C_TSADC_TRGMOD_PERIODIC_TRIGGER     (0x5) // (TSADC) Periodic Trigger (wrt TRGPER)
+#define 	AT91C_TSADC_TRGMOD_CONT_TRIGGER         (0x6) // (TSADC) Continuous Trigger
+#define AT91C_TSADC_TRGPER    (0xFFFF << 16) // (TSADC) Trigger Period
+// -------- TSADC_TSR : (TSADC Offset: 0xc) Touch Screen Register -------- 
+#define AT91C_TSADC_TSSHTIM   (0xF << 24) // (TSADC) Sample and Hold Time for Touch Screen Channels
+// -------- TSADC_CHER : (TSADC Offset: 0x10) Channel Enable Register -------- 
+#define AT91C_TSADC_CHENA0    (0x1 <<  0) // (TSADC) Channel 0 Enable
+#define AT91C_TSADC_CHENA1    (0x1 <<  1) // (TSADC) Channel 1 Enable
+#define AT91C_TSADC_CHENA2    (0x1 <<  2) // (TSADC) Channel 2 Enable
+#define AT91C_TSADC_CHENA3    (0x1 <<  3) // (TSADC) Channel 3 Enable
+#define AT91C_TSADC_CHENA4    (0x1 <<  4) // (TSADC) Channel 4 Enable
+#define AT91C_TSADC_CHENA5    (0x1 <<  5) // (TSADC) Channel 5 Enable
+#define AT91C_TSADC_CHENA6    (0x1 <<  6) // (TSADC) Channel 6 Enable
+#define AT91C_TSADC_CHENA7    (0x1 <<  7) // (TSADC) Channel 7 Enable
+// -------- TSADC_CHDR : (TSADC Offset: 0x14) Channel Disable Register -------- 
+#define AT91C_TSADC_CHDIS0    (0x1 <<  0) // (TSADC) Channel 0 Disable
+#define AT91C_TSADC_CHDIS1    (0x1 <<  1) // (TSADC) Channel 1 Disable
+#define AT91C_TSADC_CHDIS2    (0x1 <<  2) // (TSADC) Channel 2 Disable
+#define AT91C_TSADC_CHDIS3    (0x1 <<  3) // (TSADC) Channel 3 Disable
+#define AT91C_TSADC_CHDIS4    (0x1 <<  4) // (TSADC) Channel 4 Disable
+#define AT91C_TSADC_CHDIS5    (0x1 <<  5) // (TSADC) Channel 5 Disable
+#define AT91C_TSADC_CHDIS6    (0x1 <<  6) // (TSADC) Channel 6 Disable
+#define AT91C_TSADC_CHDIS7    (0x1 <<  7) // (TSADC) Channel 7 Disable
+// -------- TSADC_CHSR : (TSADC Offset: 0x18) Channel Status Register -------- 
+#define AT91C_TSADC_CHS0      (0x1 <<  0) // (TSADC) Channel 0 Status
+#define AT91C_TSADC_CHS1      (0x1 <<  1) // (TSADC) Channel 1 Status
+#define AT91C_TSADC_CHS2      (0x1 <<  2) // (TSADC) Channel 2 Status
+#define AT91C_TSADC_CHS3      (0x1 <<  3) // (TSADC) Channel 3 Status
+#define AT91C_TSADC_CHS4      (0x1 <<  4) // (TSADC) Channel 4 Status
+#define AT91C_TSADC_CHS5      (0x1 <<  5) // (TSADC) Channel 5 Status
+#define AT91C_TSADC_CHS6      (0x1 <<  6) // (TSADC) Channel 6 Status
+#define AT91C_TSADC_CHS7      (0x1 <<  7) // (TSADC) Channel 7 Status
+// -------- TSADC_SR : (TSADC Offset: 0x1c) Status Register -------- 
+#define AT91C_TSADC_EOC0      (0x1 <<  0) // (TSADC) Channel 0 End Of Conversion
+#define AT91C_TSADC_EOC1      (0x1 <<  1) // (TSADC) Channel 1 End Of Conversion
+#define AT91C_TSADC_EOC2      (0x1 <<  2) // (TSADC) Channel 2 End Of Conversion
+#define AT91C_TSADC_EOC3      (0x1 <<  3) // (TSADC) Channel 3 End Of Conversion
+#define AT91C_TSADC_EOC4      (0x1 <<  4) // (TSADC) Channel 4 End Of Conversion
+#define AT91C_TSADC_EOC5      (0x1 <<  5) // (TSADC) Channel 5 End Of Conversion
+#define AT91C_TSADC_EOC6      (0x1 <<  6) // (TSADC) Channel 6 End Of Conversion
+#define AT91C_TSADC_EOC7      (0x1 <<  7) // (TSADC) Channel 7 End Of Conversion
+#define AT91C_TSADC_OVRE0     (0x1 <<  8) // (TSADC) Channel 0 Overrun Error
+#define AT91C_TSADC_OVRE1     (0x1 <<  9) // (TSADC) Channel 1 Overrun Error
+#define AT91C_TSADC_OVRE2     (0x1 << 10) // (TSADC) Channel 2 Overrun Error
+#define AT91C_TSADC_OVRE3     (0x1 << 11) // (TSADC) Channel 3 Overrun Error
+#define AT91C_TSADC_OVRE4     (0x1 << 12) // (TSADC) Channel 4 Overrun Error
+#define AT91C_TSADC_OVRE5     (0x1 << 13) // (TSADC) Channel 5 Overrun Error
+#define AT91C_TSADC_OVRE6     (0x1 << 14) // (TSADC) Channel 6 Overrun Error
+#define AT91C_TSADC_OVRE7     (0x1 << 15) // (TSADC) Channel 7 Overrun Error
+#define AT91C_TSADC_DRDY      (0x1 << 16) // (TSADC) Data Ready
+#define AT91C_TSADC_GOVRE     (0x1 << 17) // (TSADC) General Overrun Error
+#define AT91C_TSADC_ENDRX     (0x1 << 18) // (TSADC) End of RX Buffer
+#define AT91C_TSADC_RXBUFF    (0x1 << 19) // (TSADC) RX Buffer Full
+#define AT91C_TSADC_PENCNT    (0x1 << 20) // (TSADC) Pen Contact
+#define AT91C_TSADC_NOCNT     (0x1 << 21) // (TSADC) No Contact
+// -------- TSADC_LCDR : (TSADC Offset: 0x20) Last Converted Data Register -------- 
+#define AT91C_TSADC_LDATA     (0x3FF <<  0) // (TSADC) Last Converted Data
+// -------- TSADC_IER : (TSADC Offset: 0x24) Interrupt Enable Register -------- 
+#define AT91C_TSADC_IENAEOC0  (0x1 <<  0) // (TSADC) Channel 0 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAEOC1  (0x1 <<  1) // (TSADC) Channel 1 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAEOC2  (0x1 <<  2) // (TSADC) Channel 2 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAEOC3  (0x1 <<  3) // (TSADC) Channel 3 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAEOC4  (0x1 <<  4) // (TSADC) Channel 4 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAEOC5  (0x1 <<  5) // (TSADC) Channel 5 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAEOC6  (0x1 <<  6) // (TSADC) Channel 6 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAEOC7  (0x1 <<  7) // (TSADC) Channel 7 End Of Conversion Interrupt Enable
+#define AT91C_TSADC_IENAOVRE0 (0x1 <<  8) // (TSADC) Channel 0 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAOVRE1 (0x1 <<  9) // (TSADC) Channel 1 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAOVRE2 (0x1 << 10) // (TSADC) Channel 2 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAOVRE3 (0x1 << 11) // (TSADC) Channel 3 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAOVRE4 (0x1 << 12) // (TSADC) Channel 4 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAOVRE5 (0x1 << 13) // (TSADC) Channel 5 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAOVRE6 (0x1 << 14) // (TSADC) Channel 6 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAOVRE7 (0x1 << 15) // (TSADC) Channel 7 Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENADRDY  (0x1 << 16) // (TSADC) Data Ready Interrupt Enable
+#define AT91C_TSADC_IENAGOVRE (0x1 << 17) // (TSADC) General Overrun Error Interrupt Enable
+#define AT91C_TSADC_IENAENDRX (0x1 << 18) // (TSADC) End of RX Buffer Interrupt Enable
+#define AT91C_TSADC_IENARXBUFF (0x1 << 19) // (TSADC) RX Buffer Full Interrupt Enable
+#define AT91C_TSADC_IENAPENCNT (0x1 << 20) // (TSADC) Pen Contact Interrupt Enable
+#define AT91C_TSADC_IENANOCNT (0x1 << 21) // (TSADC) No Contact Interrupt Enable
+// -------- TSADC_IDR : (TSADC Offset: 0x28) Interrupt Disable Register -------- 
+#define AT91C_TSADC_IDISEOC0  (0x1 <<  0) // (TSADC) Channel 0 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISEOC1  (0x1 <<  1) // (TSADC) Channel 1 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISEOC2  (0x1 <<  2) // (TSADC) Channel 2 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISEOC3  (0x1 <<  3) // (TSADC) Channel 3 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISEOC4  (0x1 <<  4) // (TSADC) Channel 4 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISEOC5  (0x1 <<  5) // (TSADC) Channel 5 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISEOC6  (0x1 <<  6) // (TSADC) Channel 6 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISEOC7  (0x1 <<  7) // (TSADC) Channel 7 End Of Conversion Interrupt Disable
+#define AT91C_TSADC_IDISOVRE0 (0x1 <<  8) // (TSADC) Channel 0 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISOVRE1 (0x1 <<  9) // (TSADC) Channel 1 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISOVRE2 (0x1 << 10) // (TSADC) Channel 2 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISOVRE3 (0x1 << 11) // (TSADC) Channel 3 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISOVRE4 (0x1 << 12) // (TSADC) Channel 4 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISOVRE5 (0x1 << 13) // (TSADC) Channel 5 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISOVRE6 (0x1 << 14) // (TSADC) Channel 6 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISOVRE7 (0x1 << 15) // (TSADC) Channel 7 Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISDRDY  (0x1 << 16) // (TSADC) Data Ready Interrupt Disable
+#define AT91C_TSADC_IDISGOVRE (0x1 << 17) // (TSADC) General Overrun Error Interrupt Disable
+#define AT91C_TSADC_IDISENDRX (0x1 << 18) // (TSADC) End of RX Buffer Interrupt Disable
+#define AT91C_TSADC_IDISRXBUFF (0x1 << 19) // (TSADC) RX Buffer Full Interrupt Disable
+#define AT91C_TSADC_IDISPENCNT (0x1 << 20) // (TSADC) Pen Contact Interrupt Disable
+#define AT91C_TSADC_IDISNOCNT (0x1 << 21) // (TSADC) No Contact Interrupt Disable
+// -------- TSADC_IMR : (TSADC Offset: 0x2c) Interrupt Mask Register -------- 
+#define AT91C_TSADC_IMSKEOC0  (0x1 <<  0) // (TSADC) Channel 0 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKEOC1  (0x1 <<  1) // (TSADC) Channel 1 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKEOC2  (0x1 <<  2) // (TSADC) Channel 2 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKEOC3  (0x1 <<  3) // (TSADC) Channel 3 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKEOC4  (0x1 <<  4) // (TSADC) Channel 4 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKEOC5  (0x1 <<  5) // (TSADC) Channel 5 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKEOC6  (0x1 <<  6) // (TSADC) Channel 6 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKEOC7  (0x1 <<  7) // (TSADC) Channel 7 End Of Conversion Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE0 (0x1 <<  8) // (TSADC) Channel 0 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE1 (0x1 <<  9) // (TSADC) Channel 1 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE2 (0x1 << 10) // (TSADC) Channel 2 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE3 (0x1 << 11) // (TSADC) Channel 3 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE4 (0x1 << 12) // (TSADC) Channel 4 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE5 (0x1 << 13) // (TSADC) Channel 5 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE6 (0x1 << 14) // (TSADC) Channel 6 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKOVRE7 (0x1 << 15) // (TSADC) Channel 7 Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKDRDY  (0x1 << 16) // (TSADC) Data Ready Interrupt Mask
+#define AT91C_TSADC_IMSKGOVRE (0x1 << 17) // (TSADC) General Overrun Error Interrupt Mask
+#define AT91C_TSADC_IMSKENDRX (0x1 << 18) // (TSADC) End of RX Buffer Interrupt Mask
+#define AT91C_TSADC_IMSKRXBUFF (0x1 << 19) // (TSADC) RX Buffer Full Interrupt Mask
+#define AT91C_TSADC_IMSKPENCNT (0x1 << 20) // (TSADC) Pen Contact Interrupt Mask
+#define AT91C_TSADC_IMSKNOCNT (0x1 << 21) // (TSADC) No Contact Interrupt Mask
+// -------- TSADC_CDR0 : (TSADC Offset: 0x30) Channel 0 Data Register -------- 
+#define AT91C_TSADC_DATA0     (0x3FF <<  0) // (TSADC) Channel 0 Data
+// -------- TSADC_CDR1 : (TSADC Offset: 0x34) Channel 1 Data Register -------- 
+#define AT91C_TSADC_DATA1     (0x3FF <<  0) // (TSADC) Channel 1 Data
+// -------- TSADC_CDR2 : (TSADC Offset: 0x38) Channel 2 Data Register -------- 
+#define AT91C_TSADC_DATA2     (0x3FF <<  0) // (TSADC) Channel 2 Data
+// -------- TSADC_CDR3 : (TSADC Offset: 0x3c) Channel 3 Data Register -------- 
+#define AT91C_TSADC_DATA3     (0x3FF <<  0) // (TSADC) Channel 3 Data
+// -------- TSADC_CDR4 : (TSADC Offset: 0x40) Channel 4 Data Register -------- 
+#define AT91C_TSADC_DATA4     (0x3FF <<  0) // (TSADC) Channel 4 Data
+// -------- TSADC_CDR5 : (TSADC Offset: 0x44) Channel 5 Data Register -------- 
+#define AT91C_TSADC_DATA5     (0x3FF <<  0) // (TSADC) Channel 5 Data
+// -------- TSADC_CDR6 : (TSADC Offset: 0x48) Channel 6 Data Register -------- 
+#define AT91C_TSADC_DATA6     (0x3FF <<  0) // (TSADC) Channel 6 Data
+// -------- TSADC_CDR7 : (TSADC Offset: 0x4c) Channel 7 Data Register -------- 
+#define AT91C_TSADC_DATA7     (0x3FF <<  0) // (TSADC) Channel 7 Data
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR UDPHS Enpoint FIFO data register
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_UDPHS_EPTFIFO {
+	AT91_REG	 UDPHS_READEPT0[16384]; 	// FIFO Endpoint Data Register 0
+	AT91_REG	 UDPHS_READEPT1[16384]; 	// FIFO Endpoint Data Register 1
+	AT91_REG	 UDPHS_READEPT2[16384]; 	// FIFO Endpoint Data Register 2
+	AT91_REG	 UDPHS_READEPT3[16384]; 	// FIFO Endpoint Data Register 3
+	AT91_REG	 UDPHS_READEPT4[16384]; 	// FIFO Endpoint Data Register 4
+	AT91_REG	 UDPHS_READEPT5[16384]; 	// FIFO Endpoint Data Register 5
+	AT91_REG	 UDPHS_READEPT6[16384]; 	// FIFO Endpoint Data Register 6
+} AT91S_UDPHS_EPTFIFO, *AT91PS_UDPHS_EPTFIFO;
+#else
+#define UDPHS_READEPT0  (AT91_CAST(AT91_REG *) 	0x00000000) // (UDPHS_READEPT0) FIFO Endpoint Data Register 0
+#define UDPHS_READEPT1  (AT91_CAST(AT91_REG *) 	0x00010000) // (UDPHS_READEPT1) FIFO Endpoint Data Register 1
+#define UDPHS_READEPT2  (AT91_CAST(AT91_REG *) 	0x00020000) // (UDPHS_READEPT2) FIFO Endpoint Data Register 2
+#define UDPHS_READEPT3  (AT91_CAST(AT91_REG *) 	0x00030000) // (UDPHS_READEPT3) FIFO Endpoint Data Register 3
+#define UDPHS_READEPT4  (AT91_CAST(AT91_REG *) 	0x00040000) // (UDPHS_READEPT4) FIFO Endpoint Data Register 4
+#define UDPHS_READEPT5  (AT91_CAST(AT91_REG *) 	0x00050000) // (UDPHS_READEPT5) FIFO Endpoint Data Register 5
+#define UDPHS_READEPT6  (AT91_CAST(AT91_REG *) 	0x00060000) // (UDPHS_READEPT6) FIFO Endpoint Data Register 6
+
+#endif
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR UDPHS Endpoint struct
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_UDPHS_EPT {
+	AT91_REG	 UDPHS_EPTCFG; 	// UDPHS Endpoint Config Register
+	AT91_REG	 UDPHS_EPTCTLENB; 	// UDPHS Endpoint Control Enable Register
+	AT91_REG	 UDPHS_EPTCTLDIS; 	// UDPHS Endpoint Control Disable Register
+	AT91_REG	 UDPHS_EPTCTL; 	// UDPHS Endpoint Control Register
+	AT91_REG	 Reserved0[1]; 	// 
+	AT91_REG	 UDPHS_EPTSETSTA; 	// UDPHS Endpoint Set Status Register
+	AT91_REG	 UDPHS_EPTCLRSTA; 	// UDPHS Endpoint Clear Status Register
+	AT91_REG	 UDPHS_EPTSTA; 	// UDPHS Endpoint Status Register
+} AT91S_UDPHS_EPT, *AT91PS_UDPHS_EPT;
+#else
+#define UDPHS_EPTCFG    (AT91_CAST(AT91_REG *) 	0x00000000) // (UDPHS_EPTCFG) UDPHS Endpoint Config Register
+#define UDPHS_EPTCTLENB (AT91_CAST(AT91_REG *) 	0x00000004) // (UDPHS_EPTCTLENB) UDPHS Endpoint Control Enable Register
+#define UDPHS_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0x00000008) // (UDPHS_EPTCTLDIS) UDPHS Endpoint Control Disable Register
+#define UDPHS_EPTCTL    (AT91_CAST(AT91_REG *) 	0x0000000C) // (UDPHS_EPTCTL) UDPHS Endpoint Control Register
+#define UDPHS_EPTSETSTA (AT91_CAST(AT91_REG *) 	0x00000014) // (UDPHS_EPTSETSTA) UDPHS Endpoint Set Status Register
+#define UDPHS_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0x00000018) // (UDPHS_EPTCLRSTA) UDPHS Endpoint Clear Status Register
+#define UDPHS_EPTSTA    (AT91_CAST(AT91_REG *) 	0x0000001C) // (UDPHS_EPTSTA) UDPHS Endpoint Status Register
+
+#endif
+// -------- UDPHS_EPTCFG : (UDPHS_EPT Offset: 0x0) UDPHS Endpoint Config Register -------- 
+#define AT91C_UDPHS_EPT_SIZE  (0x7 <<  0) // (UDPHS_EPT) Endpoint Size
+#define 	AT91C_UDPHS_EPT_SIZE_8                    (0x0) // (UDPHS_EPT)    8 bytes
+#define 	AT91C_UDPHS_EPT_SIZE_16                   (0x1) // (UDPHS_EPT)   16 bytes
+#define 	AT91C_UDPHS_EPT_SIZE_32                   (0x2) // (UDPHS_EPT)   32 bytes
+#define 	AT91C_UDPHS_EPT_SIZE_64                   (0x3) // (UDPHS_EPT)   64 bytes
+#define 	AT91C_UDPHS_EPT_SIZE_128                  (0x4) // (UDPHS_EPT)  128 bytes
+#define 	AT91C_UDPHS_EPT_SIZE_256                  (0x5) // (UDPHS_EPT)  256 bytes (if possible)
+#define 	AT91C_UDPHS_EPT_SIZE_512                  (0x6) // (UDPHS_EPT)  512 bytes (if possible)
+#define 	AT91C_UDPHS_EPT_SIZE_1024                 (0x7) // (UDPHS_EPT) 1024 bytes (if possible)
+#define AT91C_UDPHS_EPT_DIR   (0x1 <<  3) // (UDPHS_EPT) Endpoint Direction 0:OUT, 1:IN
+#define 	AT91C_UDPHS_EPT_DIR_OUT                  (0x0 <<  3) // (UDPHS_EPT) Direction OUT
+#define 	AT91C_UDPHS_EPT_DIR_IN                   (0x1 <<  3) // (UDPHS_EPT) Direction IN
+#define AT91C_UDPHS_EPT_TYPE  (0x3 <<  4) // (UDPHS_EPT) Endpoint Type
+#define 	AT91C_UDPHS_EPT_TYPE_CTL_EPT              (0x0 <<  4) // (UDPHS_EPT) Control endpoint
+#define 	AT91C_UDPHS_EPT_TYPE_ISO_EPT              (0x1 <<  4) // (UDPHS_EPT) Isochronous endpoint
+#define 	AT91C_UDPHS_EPT_TYPE_BUL_EPT              (0x2 <<  4) // (UDPHS_EPT) Bulk endpoint
+#define 	AT91C_UDPHS_EPT_TYPE_INT_EPT              (0x3 <<  4) // (UDPHS_EPT) Interrupt endpoint
+#define AT91C_UDPHS_BK_NUMBER (0x3 <<  6) // (UDPHS_EPT) Number of Banks
+#define 	AT91C_UDPHS_BK_NUMBER_0                    (0x0 <<  6) // (UDPHS_EPT) Zero Bank, the EndPoint is not mapped in memory
+#define 	AT91C_UDPHS_BK_NUMBER_1                    (0x1 <<  6) // (UDPHS_EPT) One Bank (Bank0)
+#define 	AT91C_UDPHS_BK_NUMBER_2                    (0x2 <<  6) // (UDPHS_EPT) Double bank (Ping-Pong : Bank0 / Bank1)
+#define 	AT91C_UDPHS_BK_NUMBER_3                    (0x3 <<  6) // (UDPHS_EPT) Triple Bank (Bank0 / Bank1 / Bank2) (if possible)
+#define AT91C_UDPHS_NB_TRANS  (0x3 <<  8) // (UDPHS_EPT) Number Of Transaction per Micro-Frame (High-Bandwidth iso only)
+#define AT91C_UDPHS_EPT_MAPD  (0x1 << 31) // (UDPHS_EPT) Endpoint Mapped (read only
+// -------- UDPHS_EPTCTLENB : (UDPHS_EPT Offset: 0x4) UDPHS Endpoint Control Enable Register -------- 
+#define AT91C_UDPHS_EPT_ENABL (0x1 <<  0) // (UDPHS_EPT) Endpoint Enable
+#define AT91C_UDPHS_AUTO_VALID (0x1 <<  1) // (UDPHS_EPT) Packet Auto-Valid Enable/Disable
+#define AT91C_UDPHS_INTDIS_DMA (0x1 <<  3) // (UDPHS_EPT) Endpoint Interrupts DMA Request Enable/Disable
+#define AT91C_UDPHS_NYET_DIS  (0x1 <<  4) // (UDPHS_EPT) NYET Enable/Disable
+#define AT91C_UDPHS_DATAX_RX  (0x1 <<  6) // (UDPHS_EPT) DATAx Interrupt Enable/Disable
+#define AT91C_UDPHS_MDATA_RX  (0x1 <<  7) // (UDPHS_EPT) MDATA Interrupt Enabled/Disable
+#define AT91C_UDPHS_ERR_OVFLW (0x1 <<  8) // (UDPHS_EPT) OverFlow Error Interrupt Enable/Disable/Status
+#define AT91C_UDPHS_RX_BK_RDY (0x1 <<  9) // (UDPHS_EPT) Received OUT Data
+#define AT91C_UDPHS_TX_COMPLT (0x1 << 10) // (UDPHS_EPT) Transmitted IN Data Complete Interrupt Enable/Disable or Transmitted IN Data Complete (clear)
+#define AT91C_UDPHS_ERR_TRANS (0x1 << 11) // (UDPHS_EPT) Transaction Error Interrupt Enable/Disable
+#define AT91C_UDPHS_TX_PK_RDY (0x1 << 11) // (UDPHS_EPT) TX Packet Ready Interrupt Enable/Disable
+#define AT91C_UDPHS_RX_SETUP  (0x1 << 12) // (UDPHS_EPT) Received SETUP Interrupt Enable/Disable
+#define AT91C_UDPHS_ERR_FL_ISO (0x1 << 12) // (UDPHS_EPT) Error Flow Clear/Interrupt Enable/Disable
+#define AT91C_UDPHS_STALL_SNT (0x1 << 13) // (UDPHS_EPT) Stall Sent Clear
+#define AT91C_UDPHS_ERR_CRISO (0x1 << 13) // (UDPHS_EPT) CRC error / Error NB Trans / Interrupt Enable/Disable
+#define AT91C_UDPHS_NAK_IN    (0x1 << 14) // (UDPHS_EPT) NAKIN ERROR FLUSH / Clear / Interrupt Enable/Disable
+#define AT91C_UDPHS_NAK_OUT   (0x1 << 15) // (UDPHS_EPT) NAKOUT / Clear / Interrupt Enable/Disable
+#define AT91C_UDPHS_BUSY_BANK (0x1 << 18) // (UDPHS_EPT) Busy Bank Interrupt Enable/Disable
+#define AT91C_UDPHS_SHRT_PCKT (0x1 << 31) // (UDPHS_EPT) Short Packet / Interrupt Enable/Disable
+// -------- UDPHS_EPTCTLDIS : (UDPHS_EPT Offset: 0x8) UDPHS Endpoint Control Disable Register -------- 
+#define AT91C_UDPHS_EPT_DISABL (0x1 <<  0) // (UDPHS_EPT) Endpoint Disable
+// -------- UDPHS_EPTCTL : (UDPHS_EPT Offset: 0xc) UDPHS Endpoint Control Register -------- 
+// -------- UDPHS_EPTSETSTA : (UDPHS_EPT Offset: 0x14) UDPHS Endpoint Set Status Register -------- 
+#define AT91C_UDPHS_FRCESTALL (0x1 <<  5) // (UDPHS_EPT) Stall Handshake Request Set/Clear/Status
+#define AT91C_UDPHS_KILL_BANK (0x1 <<  9) // (UDPHS_EPT) KILL Bank
+// -------- UDPHS_EPTCLRSTA : (UDPHS_EPT Offset: 0x18) UDPHS Endpoint Clear Status Register -------- 
+#define AT91C_UDPHS_TOGGLESQ  (0x1 <<  6) // (UDPHS_EPT) Data Toggle Clear
+// -------- UDPHS_EPTSTA : (UDPHS_EPT Offset: 0x1c) UDPHS Endpoint Status Register -------- 
+#define AT91C_UDPHS_TOGGLESQ_STA (0x3 <<  6) // (UDPHS_EPT) Toggle Sequencing
+#define 	AT91C_UDPHS_TOGGLESQ_STA_00                   (0x0 <<  6) // (UDPHS_EPT) Data0
+#define 	AT91C_UDPHS_TOGGLESQ_STA_01                   (0x1 <<  6) // (UDPHS_EPT) Data1
+#define 	AT91C_UDPHS_TOGGLESQ_STA_10                   (0x2 <<  6) // (UDPHS_EPT) Data2 (only for High-Bandwidth Isochronous EndPoint)
+#define 	AT91C_UDPHS_TOGGLESQ_STA_11                   (0x3 <<  6) // (UDPHS_EPT) MData (only for High-Bandwidth Isochronous EndPoint)
+#define AT91C_UDPHS_CONTROL_DIR (0x3 << 16) // (UDPHS_EPT) 
+#define 	AT91C_UDPHS_CONTROL_DIR_00                   (0x0 << 16) // (UDPHS_EPT) Bank 0
+#define 	AT91C_UDPHS_CONTROL_DIR_01                   (0x1 << 16) // (UDPHS_EPT) Bank 1
+#define 	AT91C_UDPHS_CONTROL_DIR_10                   (0x2 << 16) // (UDPHS_EPT) Bank 2
+#define 	AT91C_UDPHS_CONTROL_DIR_11                   (0x3 << 16) // (UDPHS_EPT) Invalid
+#define AT91C_UDPHS_CURRENT_BANK (0x3 << 16) // (UDPHS_EPT) 
+#define 	AT91C_UDPHS_CURRENT_BANK_00                   (0x0 << 16) // (UDPHS_EPT) Bank 0
+#define 	AT91C_UDPHS_CURRENT_BANK_01                   (0x1 << 16) // (UDPHS_EPT) Bank 1
+#define 	AT91C_UDPHS_CURRENT_BANK_10                   (0x2 << 16) // (UDPHS_EPT) Bank 2
+#define 	AT91C_UDPHS_CURRENT_BANK_11                   (0x3 << 16) // (UDPHS_EPT) Invalid
+#define AT91C_UDPHS_BUSY_BANK_STA (0x3 << 18) // (UDPHS_EPT) Busy Bank Number
+#define 	AT91C_UDPHS_BUSY_BANK_STA_00                   (0x0 << 18) // (UDPHS_EPT) All banks are free
+#define 	AT91C_UDPHS_BUSY_BANK_STA_01                   (0x1 << 18) // (UDPHS_EPT) 1 busy bank
+#define 	AT91C_UDPHS_BUSY_BANK_STA_10                   (0x2 << 18) // (UDPHS_EPT) 2 busy banks
+#define 	AT91C_UDPHS_BUSY_BANK_STA_11                   (0x3 << 18) // (UDPHS_EPT) 3 busy banks (if possible)
+#define AT91C_UDPHS_BYTE_COUNT (0x7FF << 20) // (UDPHS_EPT) UDPHS Byte Count
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR UDPHS DMA struct
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_UDPHS_DMA {
+	AT91_REG	 UDPHS_DMANXTDSC; 	// UDPHS DMA Channel Next Descriptor Address
+	AT91_REG	 UDPHS_DMAADDRESS; 	// UDPHS DMA Channel Address Register
+	AT91_REG	 UDPHS_DMACONTROL; 	// UDPHS DMA Channel Control Register
+	AT91_REG	 UDPHS_DMASTATUS; 	// UDPHS DMA Channel Status Register
+} AT91S_UDPHS_DMA, *AT91PS_UDPHS_DMA;
+#else
+#define UDPHS_DMANXTDSC (AT91_CAST(AT91_REG *) 	0x00000000) // (UDPHS_DMANXTDSC) UDPHS DMA Channel Next Descriptor Address
+#define UDPHS_DMAADDRESS (AT91_CAST(AT91_REG *) 	0x00000004) // (UDPHS_DMAADDRESS) UDPHS DMA Channel Address Register
+#define UDPHS_DMACONTROL (AT91_CAST(AT91_REG *) 	0x00000008) // (UDPHS_DMACONTROL) UDPHS DMA Channel Control Register
+#define UDPHS_DMASTATUS (AT91_CAST(AT91_REG *) 	0x0000000C) // (UDPHS_DMASTATUS) UDPHS DMA Channel Status Register
+
+#endif
+// -------- UDPHS_DMANXTDSC : (UDPHS_DMA Offset: 0x0) UDPHS DMA Next Descriptor Address Register -------- 
+#define AT91C_UDPHS_NXT_DSC_ADD (0xFFFFFFF <<  4) // (UDPHS_DMA) next Channel Descriptor
+// -------- UDPHS_DMAADDRESS : (UDPHS_DMA Offset: 0x4) UDPHS DMA Channel Address Register -------- 
+#define AT91C_UDPHS_BUFF_ADD  (0x0 <<  0) // (UDPHS_DMA) starting address of a DMA Channel transfer
+// -------- UDPHS_DMACONTROL : (UDPHS_DMA Offset: 0x8) UDPHS DMA Channel Control Register -------- 
+#define AT91C_UDPHS_CHANN_ENB (0x1 <<  0) // (UDPHS_DMA) Channel Enabled
+#define AT91C_UDPHS_LDNXT_DSC (0x1 <<  1) // (UDPHS_DMA) Load Next Channel Transfer Descriptor Enable
+#define AT91C_UDPHS_END_TR_EN (0x1 <<  2) // (UDPHS_DMA) Buffer Close Input Enable
+#define AT91C_UDPHS_END_B_EN  (0x1 <<  3) // (UDPHS_DMA) End of DMA Buffer Packet Validation
+#define AT91C_UDPHS_END_TR_IT (0x1 <<  4) // (UDPHS_DMA) End Of Transfer Interrupt Enable
+#define AT91C_UDPHS_END_BUFFIT (0x1 <<  5) // (UDPHS_DMA) End Of Channel Buffer Interrupt Enable
+#define AT91C_UDPHS_DESC_LD_IT (0x1 <<  6) // (UDPHS_DMA) Descriptor Loaded Interrupt Enable
+#define AT91C_UDPHS_BURST_LCK (0x1 <<  7) // (UDPHS_DMA) Burst Lock Enable
+#define AT91C_UDPHS_BUFF_LENGTH (0xFFFF << 16) // (UDPHS_DMA) Buffer Byte Length (write only)
+// -------- UDPHS_DMASTATUS : (UDPHS_DMA Offset: 0xc) UDPHS DMA Channelx Status Register -------- 
+#define AT91C_UDPHS_CHANN_ACT (0x1 <<  1) // (UDPHS_DMA) 
+#define AT91C_UDPHS_END_TR_ST (0x1 <<  4) // (UDPHS_DMA) 
+#define AT91C_UDPHS_END_BF_ST (0x1 <<  5) // (UDPHS_DMA) 
+#define AT91C_UDPHS_DESC_LDST (0x1 <<  6) // (UDPHS_DMA) 
+#define AT91C_UDPHS_BUFF_COUNT (0xFFFF << 16) // (UDPHS_DMA) 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR UDPHS High Speed Device Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_UDPHS {
+	AT91_REG	 UDPHS_CTRL; 	// UDPHS Control Register
+	AT91_REG	 UDPHS_FNUM; 	// UDPHS Frame Number Register
+	AT91_REG	 Reserved0[2]; 	// 
+	AT91_REG	 UDPHS_IEN; 	// UDPHS Interrupt Enable Register
+	AT91_REG	 UDPHS_INTSTA; 	// UDPHS Interrupt Status Register
+	AT91_REG	 UDPHS_CLRINT; 	// UDPHS Clear Interrupt Register
+	AT91_REG	 UDPHS_EPTRST; 	// UDPHS Endpoints Reset Register
+	AT91_REG	 Reserved1[44]; 	// 
+	AT91_REG	 UDPHS_TSTSOFCNT; 	// UDPHS Test SOF Counter Register
+	AT91_REG	 UDPHS_TSTCNTA; 	// UDPHS Test A Counter Register
+	AT91_REG	 UDPHS_TSTCNTB; 	// UDPHS Test B Counter Register
+	AT91_REG	 UDPHS_TSTMODREG; 	// UDPHS Test Mode Register
+	AT91_REG	 UDPHS_TST; 	// UDPHS Test Register
+	AT91_REG	 Reserved2[2]; 	// 
+	AT91_REG	 UDPHS_RIPPADDRSIZE; 	// UDPHS PADDRSIZE Register
+	AT91_REG	 UDPHS_RIPNAME1; 	// UDPHS Name1 Register
+	AT91_REG	 UDPHS_RIPNAME2; 	// UDPHS Name2 Register
+	AT91_REG	 UDPHS_IPFEATURES; 	// UDPHS Features Register
+	AT91_REG	 UDPHS_IPVERSION; 	// UDPHS Version Register
+	AT91S_UDPHS_EPT	 UDPHS_EPT[7]; 	// UDPHS Endpoint struct
+	AT91_REG	 Reserved3[72]; 	// 
+	AT91S_UDPHS_DMA	 UDPHS_DMA[6]; 	// UDPHS DMA channel struct (not use [0])
+} AT91S_UDPHS, *AT91PS_UDPHS;
+#else
+#define UDPHS_CTRL      (AT91_CAST(AT91_REG *) 	0x00000000) // (UDPHS_CTRL) UDPHS Control Register
+#define UDPHS_FNUM      (AT91_CAST(AT91_REG *) 	0x00000004) // (UDPHS_FNUM) UDPHS Frame Number Register
+#define UDPHS_IEN       (AT91_CAST(AT91_REG *) 	0x00000010) // (UDPHS_IEN) UDPHS Interrupt Enable Register
+#define UDPHS_INTSTA    (AT91_CAST(AT91_REG *) 	0x00000014) // (UDPHS_INTSTA) UDPHS Interrupt Status Register
+#define UDPHS_CLRINT    (AT91_CAST(AT91_REG *) 	0x00000018) // (UDPHS_CLRINT) UDPHS Clear Interrupt Register
+#define UDPHS_EPTRST    (AT91_CAST(AT91_REG *) 	0x0000001C) // (UDPHS_EPTRST) UDPHS Endpoints Reset Register
+#define UDPHS_TSTSOFCNT (AT91_CAST(AT91_REG *) 	0x000000D0) // (UDPHS_TSTSOFCNT) UDPHS Test SOF Counter Register
+#define UDPHS_TSTCNTA   (AT91_CAST(AT91_REG *) 	0x000000D4) // (UDPHS_TSTCNTA) UDPHS Test A Counter Register
+#define UDPHS_TSTCNTB   (AT91_CAST(AT91_REG *) 	0x000000D8) // (UDPHS_TSTCNTB) UDPHS Test B Counter Register
+#define UDPHS_TSTMODREG (AT91_CAST(AT91_REG *) 	0x000000DC) // (UDPHS_TSTMODREG) UDPHS Test Mode Register
+#define UDPHS_TST       (AT91_CAST(AT91_REG *) 	0x000000E0) // (UDPHS_TST) UDPHS Test Register
+#define UDPHS_RIPPADDRSIZE (AT91_CAST(AT91_REG *) 	0x000000EC) // (UDPHS_RIPPADDRSIZE) UDPHS PADDRSIZE Register
+#define UDPHS_RIPNAME1  (AT91_CAST(AT91_REG *) 	0x000000F0) // (UDPHS_RIPNAME1) UDPHS Name1 Register
+#define UDPHS_RIPNAME2  (AT91_CAST(AT91_REG *) 	0x000000F4) // (UDPHS_RIPNAME2) UDPHS Name2 Register
+#define UDPHS_IPFEATURES (AT91_CAST(AT91_REG *) 	0x000000F8) // (UDPHS_IPFEATURES) UDPHS Features Register
+#define UDPHS_IPVERSION (AT91_CAST(AT91_REG *) 	0x000000FC) // (UDPHS_IPVERSION) UDPHS Version Register
+
+#endif
+// -------- UDPHS_CTRL : (UDPHS Offset: 0x0) UDPHS Control Register -------- 
+#define AT91C_UDPHS_DEV_ADDR  (0x7F <<  0) // (UDPHS) UDPHS Address
+#define AT91C_UDPHS_FADDR_EN  (0x1 <<  7) // (UDPHS) Function Address Enable
+#define AT91C_UDPHS_EN_UDPHS  (0x1 <<  8) // (UDPHS) UDPHS Enable
+#define AT91C_UDPHS_DETACH    (0x1 <<  9) // (UDPHS) Detach Command
+#define AT91C_UDPHS_REWAKEUP  (0x1 << 10) // (UDPHS) Send Remote Wake Up
+#define AT91C_UDPHS_PULLD_DIS (0x1 << 11) // (UDPHS) PullDown Disable
+// -------- UDPHS_FNUM : (UDPHS Offset: 0x4) UDPHS Frame Number Register -------- 
+#define AT91C_UDPHS_MICRO_FRAME_NUM (0x7 <<  0) // (UDPHS) Micro Frame Number
+#define AT91C_UDPHS_FRAME_NUMBER (0x7FF <<  3) // (UDPHS) Frame Number as defined in the Packet Field Formats
+#define AT91C_UDPHS_FNUM_ERR  (0x1 << 31) // (UDPHS) Frame Number CRC Error
+// -------- UDPHS_IEN : (UDPHS Offset: 0x10) UDPHS Interrupt Enable Register -------- 
+#define AT91C_UDPHS_DET_SUSPD (0x1 <<  1) // (UDPHS) Suspend Interrupt Enable/Clear/Status
+#define AT91C_UDPHS_MICRO_SOF (0x1 <<  2) // (UDPHS) Micro-SOF Interrupt Enable/Clear/Status
+#define AT91C_UDPHS_IEN_SOF   (0x1 <<  3) // (UDPHS) SOF Interrupt Enable/Clear/Status
+#define AT91C_UDPHS_ENDRESET  (0x1 <<  4) // (UDPHS) End Of Reset Interrupt Enable/Clear/Status
+#define AT91C_UDPHS_WAKE_UP   (0x1 <<  5) // (UDPHS) Wake Up CPU Interrupt Enable/Clear/Status
+#define AT91C_UDPHS_ENDOFRSM  (0x1 <<  6) // (UDPHS) End Of Resume Interrupt Enable/Clear/Status
+#define AT91C_UDPHS_UPSTR_RES (0x1 <<  7) // (UDPHS) Upstream Resume Interrupt Enable/Clear/Status
+#define AT91C_UDPHS_EPT_INT_0 (0x1 <<  8) // (UDPHS) Endpoint 0 Interrupt Enable/Status
+#define AT91C_UDPHS_EPT_INT_1 (0x1 <<  9) // (UDPHS) Endpoint 1 Interrupt Enable/Status
+#define AT91C_UDPHS_EPT_INT_2 (0x1 << 10) // (UDPHS) Endpoint 2 Interrupt Enable/Status
+#define AT91C_UDPHS_EPT_INT_3 (0x1 << 11) // (UDPHS) Endpoint 3 Interrupt Enable/Status
+#define AT91C_UDPHS_EPT_INT_4 (0x1 << 12) // (UDPHS) Endpoint 4 Interrupt Enable/Status
+#define AT91C_UDPHS_EPT_INT_5 (0x1 << 13) // (UDPHS) Endpoint 5 Interrupt Enable/Status
+#define AT91C_UDPHS_EPT_INT_6 (0x1 << 14) // (UDPHS) Endpoint 6 Interrupt Enable/Status
+#define AT91C_UDPHS_DMA_INT_1 (0x1 << 25) // (UDPHS) DMA Channel 1 Interrupt Enable/Status
+#define AT91C_UDPHS_DMA_INT_2 (0x1 << 26) // (UDPHS) DMA Channel 2 Interrupt Enable/Status
+#define AT91C_UDPHS_DMA_INT_3 (0x1 << 27) // (UDPHS) DMA Channel 3 Interrupt Enable/Status
+#define AT91C_UDPHS_DMA_INT_4 (0x1 << 28) // (UDPHS) DMA Channel 4 Interrupt Enable/Status
+#define AT91C_UDPHS_DMA_INT_5 (0x1 << 29) // (UDPHS) DMA Channel 5 Interrupt Enable/Status
+#define AT91C_UDPHS_DMA_INT_6 (0x1 << 30) // (UDPHS) DMA Channel 6 Interrupt Enable/Status
+// -------- UDPHS_INTSTA : (UDPHS Offset: 0x14) UDPHS Interrupt Status Register -------- 
+#define AT91C_UDPHS_SPEED     (0x1 <<  0) // (UDPHS) Speed Status
+// -------- UDPHS_CLRINT : (UDPHS Offset: 0x18) UDPHS Clear Interrupt Register -------- 
+// -------- UDPHS_EPTRST : (UDPHS Offset: 0x1c) UDPHS Endpoints Reset Register -------- 
+#define AT91C_UDPHS_RST_EPT_0 (0x1 <<  0) // (UDPHS) Endpoint Reset 0
+#define AT91C_UDPHS_RST_EPT_1 (0x1 <<  1) // (UDPHS) Endpoint Reset 1
+#define AT91C_UDPHS_RST_EPT_2 (0x1 <<  2) // (UDPHS) Endpoint Reset 2
+#define AT91C_UDPHS_RST_EPT_3 (0x1 <<  3) // (UDPHS) Endpoint Reset 3
+#define AT91C_UDPHS_RST_EPT_4 (0x1 <<  4) // (UDPHS) Endpoint Reset 4
+#define AT91C_UDPHS_RST_EPT_5 (0x1 <<  5) // (UDPHS) Endpoint Reset 5
+#define AT91C_UDPHS_RST_EPT_6 (0x1 <<  6) // (UDPHS) Endpoint Reset 6
+// -------- UDPHS_TSTSOFCNT : (UDPHS Offset: 0xd0) UDPHS Test SOF Counter Register -------- 
+#define AT91C_UDPHS_SOFCNTMAX (0x3 <<  0) // (UDPHS) SOF Counter Max Value
+#define AT91C_UDPHS_SOFCTLOAD (0x1 <<  7) // (UDPHS) SOF Counter Load
+// -------- UDPHS_TSTCNTA : (UDPHS Offset: 0xd4) UDPHS Test A Counter Register -------- 
+#define AT91C_UDPHS_CNTAMAX   (0x7FFF <<  0) // (UDPHS) A Counter Max Value
+#define AT91C_UDPHS_CNTALOAD  (0x1 << 15) // (UDPHS) A Counter Load
+// -------- UDPHS_TSTCNTB : (UDPHS Offset: 0xd8) UDPHS Test B Counter Register -------- 
+#define AT91C_UDPHS_CNTBMAX   (0x7FFF <<  0) // (UDPHS) B Counter Max Value
+#define AT91C_UDPHS_CNTBLOAD  (0x1 << 15) // (UDPHS) B Counter Load
+// -------- UDPHS_TSTMODREG : (UDPHS Offset: 0xdc) UDPHS Test Mode Register -------- 
+#define AT91C_UDPHS_TSTMODE   (0x1F <<  1) // (UDPHS) UDPHS Core TestModeReg
+// -------- UDPHS_TST : (UDPHS Offset: 0xe0) UDPHS Test Register -------- 
+#define AT91C_UDPHS_SPEED_CFG (0x3 <<  0) // (UDPHS) Speed Configuration
+#define 	AT91C_UDPHS_SPEED_CFG_NM                   (0x0) // (UDPHS) Normal Mode
+#define 	AT91C_UDPHS_SPEED_CFG_RS                   (0x1) // (UDPHS) Reserved
+#define 	AT91C_UDPHS_SPEED_CFG_HS                   (0x2) // (UDPHS) Force High Speed
+#define 	AT91C_UDPHS_SPEED_CFG_FS                   (0x3) // (UDPHS) Force Full-Speed
+#define AT91C_UDPHS_TST_J     (0x1 <<  2) // (UDPHS) TestJMode
+#define AT91C_UDPHS_TST_K     (0x1 <<  3) // (UDPHS) TestKMode
+#define AT91C_UDPHS_TST_PKT   (0x1 <<  4) // (UDPHS) TestPacketMode
+#define AT91C_UDPHS_OPMODE2   (0x1 <<  5) // (UDPHS) OpMode2
+// -------- UDPHS_RIPPADDRSIZE : (UDPHS Offset: 0xec) UDPHS PADDRSIZE Register -------- 
+#define AT91C_UDPHS_IPPADDRSIZE (0x0 <<  0) // (UDPHS) 2^UDPHSDEV_PADDR_SIZE
+// -------- UDPHS_RIPNAME1 : (UDPHS Offset: 0xf0) UDPHS Name Register -------- 
+#define AT91C_UDPHS_IPNAME1   (0x0 <<  0) // (UDPHS) ASCII string HUSB
+// -------- UDPHS_RIPNAME2 : (UDPHS Offset: 0xf4) UDPHS Name Register -------- 
+#define AT91C_UDPHS_IPNAME2   (0x0 <<  0) // (UDPHS) ASCII string 2DEV
+// -------- UDPHS_IPFEATURES : (UDPHS Offset: 0xf8) UDPHS Features Register -------- 
+#define AT91C_UDPHS_EPT_NBR_MAX (0xF <<  0) // (UDPHS) Max Number of Endpoints
+#define AT91C_UDPHS_DMA_CHANNEL_NBR (0x7 <<  4) // (UDPHS) Number of DMA Channels
+#define AT91C_UDPHS_DMA_B_SIZ (0x1 <<  7) // (UDPHS) DMA Buffer Size
+#define AT91C_UDPHS_DMA_FIFO_WORD_DEPTH (0xF <<  8) // (UDPHS) DMA FIFO Depth in words
+#define AT91C_UDPHS_FIFO_MAX_SIZE (0x7 << 12) // (UDPHS) DPRAM size
+#define AT91C_UDPHS_BW_DPRAM  (0x1 << 15) // (UDPHS) DPRAM byte write capability
+#define AT91C_UDPHS_DATAB16_8 (0x1 << 16) // (UDPHS) UTMI DataBus16_8
+#define AT91C_UDPHS_ISO_EPT_1 (0x1 << 17) // (UDPHS) Endpoint 1 High Bandwidth Isochronous Capability
+#define AT91C_UDPHS_ISO_EPT_2 (0x1 << 18) // (UDPHS) Endpoint 2 High Bandwidth Isochronous Capability
+#define AT91C_UDPHS_ISO_EPT_5 (0x1 << 21) // (UDPHS) Endpoint 5 High Bandwidth Isochronous Capability
+#define AT91C_UDPHS_ISO_EPT_6 (0x1 << 22) // (UDPHS) Endpoint 6 High Bandwidth Isochronous Capability
+// -------- UDPHS_IPVERSION : (UDPHS Offset: 0xfc) UDPHS Version Register -------- 
+#define AT91C_UDPHS_VERSION_NUM (0xFFFF <<  0) // (UDPHS) Give the IP version
+#define AT91C_UDPHS_METAL_FIX_NUM (0x7 << 16) // (UDPHS) Give the number of metal fixes
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR AC97 Controller Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_AC97C {
+	AT91_REG	 Reserved0[2]; 	// 
+	AT91_REG	 AC97C_MR; 	// Mode Register
+	AT91_REG	 Reserved1[1]; 	// 
+	AT91_REG	 AC97C_ICA; 	// Input Channel AssignementRegister
+	AT91_REG	 AC97C_OCA; 	// Output Channel Assignement Register
+	AT91_REG	 Reserved2[2]; 	// 
+	AT91_REG	 AC97C_CARHR; 	// Channel A Receive Holding Register
+	AT91_REG	 AC97C_CATHR; 	// Channel A Transmit Holding Register
+	AT91_REG	 AC97C_CASR; 	// Channel A Status Register
+	AT91_REG	 AC97C_CAMR; 	// Channel A Mode Register
+	AT91_REG	 AC97C_CBRHR; 	// Channel B Receive Holding Register (optional)
+	AT91_REG	 AC97C_CBTHR; 	// Channel B Transmit Holding Register (optional)
+	AT91_REG	 AC97C_CBSR; 	// Channel B Status Register
+	AT91_REG	 AC97C_CBMR; 	// Channel B Mode Register
+	AT91_REG	 AC97C_CORHR; 	// COdec Transmit Holding Register
+	AT91_REG	 AC97C_COTHR; 	// COdec Transmit Holding Register
+	AT91_REG	 AC97C_COSR; 	// CODEC Status Register
+	AT91_REG	 AC97C_COMR; 	// CODEC Mask Status Register
+	AT91_REG	 AC97C_SR; 	// Status Register
+	AT91_REG	 AC97C_IER; 	// Interrupt Enable Register
+	AT91_REG	 AC97C_IDR; 	// Interrupt Disable Register
+	AT91_REG	 AC97C_IMR; 	// Interrupt Mask Register
+	AT91_REG	 Reserved3[39]; 	// 
+	AT91_REG	 AC97C_VERSION; 	// Version Register
+	AT91_REG	 AC97C_RPR; 	// Receive Pointer Register
+	AT91_REG	 AC97C_RCR; 	// Receive Counter Register
+	AT91_REG	 AC97C_TPR; 	// Transmit Pointer Register
+	AT91_REG	 AC97C_TCR; 	// Transmit Counter Register
+	AT91_REG	 AC97C_RNPR; 	// Receive Next Pointer Register
+	AT91_REG	 AC97C_RNCR; 	// Receive Next Counter Register
+	AT91_REG	 AC97C_TNPR; 	// Transmit Next Pointer Register
+	AT91_REG	 AC97C_TNCR; 	// Transmit Next Counter Register
+	AT91_REG	 AC97C_PTCR; 	// PDC Transfer Control Register
+	AT91_REG	 AC97C_PTSR; 	// PDC Transfer Status Register
+} AT91S_AC97C, *AT91PS_AC97C;
+#else
+#define AC97C_MR        (AT91_CAST(AT91_REG *) 	0x00000008) // (AC97C_MR) Mode Register
+#define AC97C_ICA       (AT91_CAST(AT91_REG *) 	0x00000010) // (AC97C_ICA) Input Channel AssignementRegister
+#define AC97C_OCA       (AT91_CAST(AT91_REG *) 	0x00000014) // (AC97C_OCA) Output Channel Assignement Register
+#define AC97C_CARHR     (AT91_CAST(AT91_REG *) 	0x00000020) // (AC97C_CARHR) Channel A Receive Holding Register
+#define AC97C_CATHR     (AT91_CAST(AT91_REG *) 	0x00000024) // (AC97C_CATHR) Channel A Transmit Holding Register
+#define AC97C_CASR      (AT91_CAST(AT91_REG *) 	0x00000028) // (AC97C_CASR) Channel A Status Register
+#define AC97C_CAMR      (AT91_CAST(AT91_REG *) 	0x0000002C) // (AC97C_CAMR) Channel A Mode Register
+#define AC97C_CBRHR     (AT91_CAST(AT91_REG *) 	0x00000030) // (AC97C_CBRHR) Channel B Receive Holding Register (optional)
+#define AC97C_CBTHR     (AT91_CAST(AT91_REG *) 	0x00000034) // (AC97C_CBTHR) Channel B Transmit Holding Register (optional)
+#define AC97C_CBSR      (AT91_CAST(AT91_REG *) 	0x00000038) // (AC97C_CBSR) Channel B Status Register
+#define AC97C_CBMR      (AT91_CAST(AT91_REG *) 	0x0000003C) // (AC97C_CBMR) Channel B Mode Register
+#define AC97C_CORHR     (AT91_CAST(AT91_REG *) 	0x00000040) // (AC97C_CORHR) COdec Transmit Holding Register
+#define AC97C_COTHR     (AT91_CAST(AT91_REG *) 	0x00000044) // (AC97C_COTHR) COdec Transmit Holding Register
+#define AC97C_COSR      (AT91_CAST(AT91_REG *) 	0x00000048) // (AC97C_COSR) CODEC Status Register
+#define AC97C_COMR      (AT91_CAST(AT91_REG *) 	0x0000004C) // (AC97C_COMR) CODEC Mask Status Register
+#define AC97C_SR        (AT91_CAST(AT91_REG *) 	0x00000050) // (AC97C_SR) Status Register
+#define AC97C_IER       (AT91_CAST(AT91_REG *) 	0x00000054) // (AC97C_IER) Interrupt Enable Register
+#define AC97C_IDR       (AT91_CAST(AT91_REG *) 	0x00000058) // (AC97C_IDR) Interrupt Disable Register
+#define AC97C_IMR       (AT91_CAST(AT91_REG *) 	0x0000005C) // (AC97C_IMR) Interrupt Mask Register
+#define AC97C_VERSION   (AT91_CAST(AT91_REG *) 	0x000000FC) // (AC97C_VERSION) Version Register
+
+#endif
+// -------- AC97C_MR : (AC97C Offset: 0x8) AC97C Mode Register -------- 
+#define AT91C_AC97C_ENA       (0x1 <<  0) // (AC97C) AC97 Controller Global Enable
+#define AT91C_AC97C_WRST      (0x1 <<  1) // (AC97C) Warm Reset
+#define AT91C_AC97C_VRA       (0x1 <<  2) // (AC97C) Variable RAte (for Data Slots)
+// -------- AC97C_ICA : (AC97C Offset: 0x10) AC97C Input Channel Assignement Register -------- 
+#define AT91C_AC97C_CHID3     (0x7 <<  0) // (AC97C) Channel Id for the input slot 3
+#define 	AT91C_AC97C_CHID3_NONE                 (0x0) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID3_CA                   (0x1) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID3_CB                   (0x2) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID3_CC                   (0x3) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID4     (0x7 <<  3) // (AC97C) Channel Id for the input slot 4
+#define 	AT91C_AC97C_CHID4_NONE                 (0x0 <<  3) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID4_CA                   (0x1 <<  3) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID4_CB                   (0x2 <<  3) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID4_CC                   (0x3 <<  3) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID5     (0x7 <<  6) // (AC97C) Channel Id for the input slot 5
+#define 	AT91C_AC97C_CHID5_NONE                 (0x0 <<  6) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID5_CA                   (0x1 <<  6) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID5_CB                   (0x2 <<  6) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID5_CC                   (0x3 <<  6) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID6     (0x7 <<  9) // (AC97C) Channel Id for the input slot 6
+#define 	AT91C_AC97C_CHID6_NONE                 (0x0 <<  9) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID6_CA                   (0x1 <<  9) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID6_CB                   (0x2 <<  9) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID6_CC                   (0x3 <<  9) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID7     (0x7 << 12) // (AC97C) Channel Id for the input slot 7
+#define 	AT91C_AC97C_CHID7_NONE                 (0x0 << 12) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID7_CA                   (0x1 << 12) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID7_CB                   (0x2 << 12) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID7_CC                   (0x3 << 12) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID8     (0x7 << 15) // (AC97C) Channel Id for the input slot 8
+#define 	AT91C_AC97C_CHID8_NONE                 (0x0 << 15) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID8_CA                   (0x1 << 15) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID8_CB                   (0x2 << 15) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID8_CC                   (0x3 << 15) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID9     (0x7 << 18) // (AC97C) Channel Id for the input slot 9
+#define 	AT91C_AC97C_CHID9_NONE                 (0x0 << 18) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID9_CA                   (0x1 << 18) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID9_CB                   (0x2 << 18) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID9_CC                   (0x3 << 18) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID10    (0x7 << 21) // (AC97C) Channel Id for the input slot 10
+#define 	AT91C_AC97C_CHID10_NONE                 (0x0 << 21) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID10_CA                   (0x1 << 21) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID10_CB                   (0x2 << 21) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID10_CC                   (0x3 << 21) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID11    (0x7 << 24) // (AC97C) Channel Id for the input slot 11
+#define 	AT91C_AC97C_CHID11_NONE                 (0x0 << 24) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID11_CA                   (0x1 << 24) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID11_CB                   (0x2 << 24) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID11_CC                   (0x3 << 24) // (AC97C) Channel C data will be transmitted during this slot
+#define AT91C_AC97C_CHID12    (0x7 << 27) // (AC97C) Channel Id for the input slot 12
+#define 	AT91C_AC97C_CHID12_NONE                 (0x0 << 27) // (AC97C) No data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID12_CA                   (0x1 << 27) // (AC97C) Channel A data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID12_CB                   (0x2 << 27) // (AC97C) Channel B data will be transmitted during this slot
+#define 	AT91C_AC97C_CHID12_CC                   (0x3 << 27) // (AC97C) Channel C data will be transmitted during this slot
+// -------- AC97C_OCA : (AC97C Offset: 0x14) AC97C Output Channel Assignement Register -------- 
+// -------- AC97C_CARHR : (AC97C Offset: 0x20) AC97C Channel A Receive Holding Register -------- 
+#define AT91C_AC97C_RDATA     (0xFFFFF <<  0) // (AC97C) Receive data
+// -------- AC97C_CATHR : (AC97C Offset: 0x24) AC97C Channel A Transmit Holding Register -------- 
+#define AT91C_AC97C_TDATA     (0xFFFFF <<  0) // (AC97C) Transmit data
+// -------- AC97C_CASR : (AC97C Offset: 0x28) AC97C Channel A Status Register -------- 
+#define AT91C_AC97C_TXRDY     (0x1 <<  0) // (AC97C) 
+#define AT91C_AC97C_TXEMPTY   (0x1 <<  1) // (AC97C) 
+#define AT91C_AC97C_UNRUN     (0x1 <<  2) // (AC97C) 
+#define AT91C_AC97C_RXRDY     (0x1 <<  4) // (AC97C) 
+#define AT91C_AC97C_OVRUN     (0x1 <<  5) // (AC97C) 
+#define AT91C_AC97C_ENDTX     (0x1 << 10) // (AC97C) 
+#define AT91C_AC97C_TXBUFE    (0x1 << 11) // (AC97C) 
+#define AT91C_AC97C_ENDRX     (0x1 << 14) // (AC97C) 
+#define AT91C_AC97C_RXBUFF    (0x1 << 15) // (AC97C) 
+// -------- AC97C_CAMR : (AC97C Offset: 0x2c) AC97C Channel A Mode Register -------- 
+#define AT91C_AC97C_SIZE      (0x3 << 16) // (AC97C) 
+#define 	AT91C_AC97C_SIZE_20_BITS              (0x0 << 16) // (AC97C) Data size is 20 bits
+#define 	AT91C_AC97C_SIZE_18_BITS              (0x1 << 16) // (AC97C) Data size is 18 bits
+#define 	AT91C_AC97C_SIZE_16_BITS              (0x2 << 16) // (AC97C) Data size is 16 bits
+#define 	AT91C_AC97C_SIZE_10_BITS              (0x3 << 16) // (AC97C) Data size is 10 bits
+#define AT91C_AC97C_CEM       (0x1 << 18) // (AC97C) 
+#define AT91C_AC97C_CEN       (0x1 << 21) // (AC97C) 
+#define AT91C_AC97C_PDCEN     (0x1 << 22) // (AC97C) 
+// -------- AC97C_CBRHR : (AC97C Offset: 0x30) AC97C Channel B Receive Holding Register -------- 
+// -------- AC97C_CBTHR : (AC97C Offset: 0x34) AC97C Channel B Transmit Holding Register -------- 
+// -------- AC97C_CBSR : (AC97C Offset: 0x38) AC97C Channel B Status Register -------- 
+// -------- AC97C_CBMR : (AC97C Offset: 0x3c) AC97C Channel B Mode Register -------- 
+// -------- AC97C_CORHR : (AC97C Offset: 0x40) AC97C Codec Channel Receive Holding Register -------- 
+#define AT91C_AC97C_SDATA     (0xFFFF <<  0) // (AC97C) Status Data
+// -------- AC97C_COTHR : (AC97C Offset: 0x44) AC97C Codec Channel Transmit Holding Register -------- 
+#define AT91C_AC97C_CDATA     (0xFFFF <<  0) // (AC97C) Command Data
+#define AT91C_AC97C_CADDR     (0x7F << 16) // (AC97C) COdec control register index
+#define AT91C_AC97C_READ      (0x1 << 23) // (AC97C) Read/Write command
+// -------- AC97C_COSR : (AC97C Offset: 0x48) AC97C CODEC Status Register -------- 
+// -------- AC97C_COMR : (AC97C Offset: 0x4c) AC97C CODEC Mode Register -------- 
+// -------- AC97C_SR : (AC97C Offset: 0x50) AC97C Status Register -------- 
+#define AT91C_AC97C_SOF       (0x1 <<  0) // (AC97C) 
+#define AT91C_AC97C_WKUP      (0x1 <<  1) // (AC97C) 
+#define AT91C_AC97C_COEVT     (0x1 <<  2) // (AC97C) 
+#define AT91C_AC97C_CAEVT     (0x1 <<  3) // (AC97C) 
+#define AT91C_AC97C_CBEVT     (0x1 <<  4) // (AC97C) 
+// -------- AC97C_IER : (AC97C Offset: 0x54) AC97C Interrupt Enable Register -------- 
+// -------- AC97C_IDR : (AC97C Offset: 0x58) AC97C Interrupt Disable Register -------- 
+// -------- AC97C_IMR : (AC97C Offset: 0x5c) AC97C Interrupt Mask Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR LCD Controller
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_LCDC {
+	AT91_REG	 LCDC_BA1; 	// DMA Base Address Register 1
+	AT91_REG	 LCDC_BA2; 	// DMA Base Address Register 2
+	AT91_REG	 LCDC_FRMP1; 	// DMA Frame Pointer Register 1
+	AT91_REG	 LCDC_FRMP2; 	// DMA Frame Pointer Register 2
+	AT91_REG	 LCDC_FRMA1; 	// DMA Frame Address Register 1
+	AT91_REG	 LCDC_FRMA2; 	// DMA Frame Address Register 2
+	AT91_REG	 LCDC_FRMCFG; 	// DMA Frame Configuration Register
+	AT91_REG	 LCDC_DMACON; 	// DMA Control Register
+	AT91_REG	 LCDC_DMA2DCFG; 	// DMA 2D addressing configuration
+	AT91_REG	 Reserved0[503]; 	// 
+	AT91_REG	 LCDC_LCDCON1; 	// LCD Control 1 Register
+	AT91_REG	 LCDC_LCDCON2; 	// LCD Control 2 Register
+	AT91_REG	 LCDC_TIM1; 	// LCD Timing Config 1 Register
+	AT91_REG	 LCDC_TIM2; 	// LCD Timing Config 2 Register
+	AT91_REG	 LCDC_LCDFRCFG; 	// LCD Frame Config Register
+	AT91_REG	 LCDC_FIFO; 	// LCD FIFO Register
+	AT91_REG	 LCDC_MVAL; 	// LCD Mode Toggle Rate Value Register
+	AT91_REG	 LCDC_DP1_2; 	// Dithering Pattern DP1_2 Register
+	AT91_REG	 LCDC_DP4_7; 	// Dithering Pattern DP4_7 Register
+	AT91_REG	 LCDC_DP3_5; 	// Dithering Pattern DP3_5 Register
+	AT91_REG	 LCDC_DP2_3; 	// Dithering Pattern DP2_3 Register
+	AT91_REG	 LCDC_DP5_7; 	// Dithering Pattern DP5_7 Register
+	AT91_REG	 LCDC_DP3_4; 	// Dithering Pattern DP3_4 Register
+	AT91_REG	 LCDC_DP4_5; 	// Dithering Pattern DP4_5 Register
+	AT91_REG	 LCDC_DP6_7; 	// Dithering Pattern DP6_7 Register
+	AT91_REG	 LCDC_PWRCON; 	// Power Control Register
+	AT91_REG	 LCDC_CTRSTCON; 	// Contrast Control Register
+	AT91_REG	 LCDC_CTRSTVAL; 	// Contrast Value Register
+	AT91_REG	 LCDC_IER; 	// Interrupt Enable Register
+	AT91_REG	 LCDC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 LCDC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 LCDC_ISR; 	// Interrupt Enable Register
+	AT91_REG	 LCDC_ICR; 	// Interrupt Clear Register
+	AT91_REG	 LCDC_GPR; 	// General Purpose Register
+	AT91_REG	 LCDC_ITR; 	// Interrupts Test Register
+	AT91_REG	 LCDC_IRR; 	// Interrupts Raw Status Register
+	AT91_REG	 Reserved1[230]; 	// 
+	AT91_REG	 LCDC_LUT_ENTRY[256]; 	// LUT Entries Register
+} AT91S_LCDC, *AT91PS_LCDC;
+#else
+#define LCDC_BA1        (AT91_CAST(AT91_REG *) 	0x00000000) // (LCDC_BA1) DMA Base Address Register 1
+#define LCDC_BA2        (AT91_CAST(AT91_REG *) 	0x00000004) // (LCDC_BA2) DMA Base Address Register 2
+#define LCDC_FRMP1      (AT91_CAST(AT91_REG *) 	0x00000008) // (LCDC_FRMP1) DMA Frame Pointer Register 1
+#define LCDC_FRMP2      (AT91_CAST(AT91_REG *) 	0x0000000C) // (LCDC_FRMP2) DMA Frame Pointer Register 2
+#define LCDC_FRMA1      (AT91_CAST(AT91_REG *) 	0x00000010) // (LCDC_FRMA1) DMA Frame Address Register 1
+#define LCDC_FRMA2      (AT91_CAST(AT91_REG *) 	0x00000014) // (LCDC_FRMA2) DMA Frame Address Register 2
+#define LCDC_FRMCFG     (AT91_CAST(AT91_REG *) 	0x00000018) // (LCDC_FRMCFG) DMA Frame Configuration Register
+#define LCDC_DMACON     (AT91_CAST(AT91_REG *) 	0x0000001C) // (LCDC_DMACON) DMA Control Register
+#define LCDC_DMA2DCFG   (AT91_CAST(AT91_REG *) 	0x00000020) // (LCDC_DMA2DCFG) DMA 2D addressing configuration
+#define LCDC_LCDCON1    (AT91_CAST(AT91_REG *) 	0x00000800) // (LCDC_LCDCON1) LCD Control 1 Register
+#define LCDC_LCDCON2    (AT91_CAST(AT91_REG *) 	0x00000804) // (LCDC_LCDCON2) LCD Control 2 Register
+#define LCDC_TIM1       (AT91_CAST(AT91_REG *) 	0x00000808) // (LCDC_TIM1) LCD Timing Config 1 Register
+#define LCDC_TIM2       (AT91_CAST(AT91_REG *) 	0x0000080C) // (LCDC_TIM2) LCD Timing Config 2 Register
+#define LCDC_LCDFRCFG   (AT91_CAST(AT91_REG *) 	0x00000810) // (LCDC_LCDFRCFG) LCD Frame Config Register
+#define LCDC_FIFO       (AT91_CAST(AT91_REG *) 	0x00000814) // (LCDC_FIFO) LCD FIFO Register
+#define LCDC_MVAL       (AT91_CAST(AT91_REG *) 	0x00000818) // (LCDC_MVAL) LCD Mode Toggle Rate Value Register
+#define LCDC_DP1_2      (AT91_CAST(AT91_REG *) 	0x0000081C) // (LCDC_DP1_2) Dithering Pattern DP1_2 Register
+#define LCDC_DP4_7      (AT91_CAST(AT91_REG *) 	0x00000820) // (LCDC_DP4_7) Dithering Pattern DP4_7 Register
+#define LCDC_DP3_5      (AT91_CAST(AT91_REG *) 	0x00000824) // (LCDC_DP3_5) Dithering Pattern DP3_5 Register
+#define LCDC_DP2_3      (AT91_CAST(AT91_REG *) 	0x00000828) // (LCDC_DP2_3) Dithering Pattern DP2_3 Register
+#define LCDC_DP5_7      (AT91_CAST(AT91_REG *) 	0x0000082C) // (LCDC_DP5_7) Dithering Pattern DP5_7 Register
+#define LCDC_DP3_4      (AT91_CAST(AT91_REG *) 	0x00000830) // (LCDC_DP3_4) Dithering Pattern DP3_4 Register
+#define LCDC_DP4_5      (AT91_CAST(AT91_REG *) 	0x00000834) // (LCDC_DP4_5) Dithering Pattern DP4_5 Register
+#define LCDC_DP6_7      (AT91_CAST(AT91_REG *) 	0x00000838) // (LCDC_DP6_7) Dithering Pattern DP6_7 Register
+#define LCDC_PWRCON     (AT91_CAST(AT91_REG *) 	0x0000083C) // (LCDC_PWRCON) Power Control Register
+#define LCDC_CTRSTCON   (AT91_CAST(AT91_REG *) 	0x00000840) // (LCDC_CTRSTCON) Contrast Control Register
+#define LCDC_CTRSTVAL   (AT91_CAST(AT91_REG *) 	0x00000844) // (LCDC_CTRSTVAL) Contrast Value Register
+#define LCDC_IER        (AT91_CAST(AT91_REG *) 	0x00000848) // (LCDC_IER) Interrupt Enable Register
+#define LCDC_IDR        (AT91_CAST(AT91_REG *) 	0x0000084C) // (LCDC_IDR) Interrupt Disable Register
+#define LCDC_IMR        (AT91_CAST(AT91_REG *) 	0x00000850) // (LCDC_IMR) Interrupt Mask Register
+#define LCDC_ISR        (AT91_CAST(AT91_REG *) 	0x00000854) // (LCDC_ISR) Interrupt Enable Register
+#define LCDC_ICR        (AT91_CAST(AT91_REG *) 	0x00000858) // (LCDC_ICR) Interrupt Clear Register
+#define LCDC_GPR        (AT91_CAST(AT91_REG *) 	0x0000085C) // (LCDC_GPR) General Purpose Register
+#define LCDC_ITR        (AT91_CAST(AT91_REG *) 	0x00000860) // (LCDC_ITR) Interrupts Test Register
+#define LCDC_IRR        (AT91_CAST(AT91_REG *) 	0x00000864) // (LCDC_IRR) Interrupts Raw Status Register
+#define LCDC_LUT_ENTRY  (AT91_CAST(AT91_REG *) 	0x00000C00) // (LCDC_LUT_ENTRY) LUT Entries Register
+
+#endif
+// -------- LCDC_FRMP1 : (LCDC Offset: 0x8) DMA Frame Pointer 1 Register -------- 
+#define AT91C_LCDC_FRMPT1     (0x3FFFFF <<  0) // (LCDC) Frame Pointer Address 1
+// -------- LCDC_FRMP2 : (LCDC Offset: 0xc) DMA Frame Pointer 2 Register -------- 
+#define AT91C_LCDC_FRMPT2     (0x1FFFFF <<  0) // (LCDC) Frame Pointer Address 2
+// -------- LCDC_FRMCFG : (LCDC Offset: 0x18) DMA Frame Config Register -------- 
+#define AT91C_LCDC_FRSIZE     (0x7FFFFF <<  0) // (LCDC) FRAME SIZE
+#define AT91C_LCDC_BLENGTH    (0x7F << 24) // (LCDC) BURST LENGTH
+// -------- LCDC_DMACON : (LCDC Offset: 0x1c) DMA Control Register -------- 
+#define AT91C_LCDC_DMAEN      (0x1 <<  0) // (LCDC) DAM Enable
+#define AT91C_LCDC_DMARST     (0x1 <<  1) // (LCDC) DMA Reset (WO)
+#define AT91C_LCDC_DMABUSY    (0x1 <<  2) // (LCDC) DMA Reset (WO)
+#define AT91C_LCDC_DMAUPDT    (0x1 <<  3) // (LCDC) DMA Configuration Update
+#define AT91C_LCDC_DMA2DEN    (0x1 <<  4) // (LCDC) 2D Addressing Enable
+// -------- LCDC_DMA2DCFG : (LCDC Offset: 0x20) DMA 2D addressing configuration Register -------- 
+#define AT91C_LCDC_ADDRINC    (0xFFFF <<  0) // (LCDC) Number of 32b words that the DMA must jump when going to the next line
+#define AT91C_LCDC_PIXELOFF   (0x1F << 24) // (LCDC) Offset (in bits) of the first pixel of the screen in the memory word which contain it
+// -------- LCDC_LCDCON1 : (LCDC Offset: 0x800) LCD Control 1 Register -------- 
+#define AT91C_LCDC_BYPASS     (0x1 <<  0) // (LCDC) Bypass lcd_pccklk divider
+#define AT91C_LCDC_CLKVAL     (0x1FF << 12) // (LCDC) 9-bit Divider for pixel clock frequency
+#define AT91C_LCDC_LINCNT     (0x7FF << 21) // (LCDC) Line Counter (RO)
+// -------- LCDC_LCDCON2 : (LCDC Offset: 0x804) LCD Control 2 Register -------- 
+#define AT91C_LCDC_DISTYPE    (0x3 <<  0) // (LCDC) Display Type
+#define 	AT91C_LCDC_DISTYPE_STNMONO              (0x0) // (LCDC) STN Mono
+#define 	AT91C_LCDC_DISTYPE_STNCOLOR             (0x1) // (LCDC) STN Color
+#define 	AT91C_LCDC_DISTYPE_TFT                  (0x2) // (LCDC) TFT
+#define AT91C_LCDC_SCANMOD    (0x1 <<  2) // (LCDC) Scan Mode
+#define 	AT91C_LCDC_SCANMOD_SINGLESCAN           (0x0 <<  2) // (LCDC) Single Scan
+#define 	AT91C_LCDC_SCANMOD_DUALSCAN             (0x1 <<  2) // (LCDC) Dual Scan
+#define AT91C_LCDC_IFWIDTH    (0x3 <<  3) // (LCDC) Interface Width
+#define 	AT91C_LCDC_IFWIDTH_FOURBITSWIDTH        (0x0 <<  3) // (LCDC) 4 Bits
+#define 	AT91C_LCDC_IFWIDTH_EIGTHBITSWIDTH       (0x1 <<  3) // (LCDC) 8 Bits
+#define 	AT91C_LCDC_IFWIDTH_SIXTEENBITSWIDTH     (0x2 <<  3) // (LCDC) 16 Bits
+#define AT91C_LCDC_PIXELSIZE  (0x7 <<  5) // (LCDC) Bits per pixel
+#define 	AT91C_LCDC_PIXELSIZE_ONEBITSPERPIXEL      (0x0 <<  5) // (LCDC) 1 Bits
+#define 	AT91C_LCDC_PIXELSIZE_TWOBITSPERPIXEL      (0x1 <<  5) // (LCDC) 2 Bits
+#define 	AT91C_LCDC_PIXELSIZE_FOURBITSPERPIXEL     (0x2 <<  5) // (LCDC) 4 Bits
+#define 	AT91C_LCDC_PIXELSIZE_EIGTHBITSPERPIXEL    (0x3 <<  5) // (LCDC) 8 Bits
+#define 	AT91C_LCDC_PIXELSIZE_SIXTEENBITSPERPIXEL  (0x4 <<  5) // (LCDC) 16 Bits
+#define 	AT91C_LCDC_PIXELSIZE_TWENTYFOURBITSPERPIXEL (0x5 <<  5) // (LCDC) 24 Bits
+#define AT91C_LCDC_INVVD      (0x1 <<  8) // (LCDC) lcd datas polarity
+#define 	AT91C_LCDC_INVVD_NORMALPOL            (0x0 <<  8) // (LCDC) Normal Polarity
+#define 	AT91C_LCDC_INVVD_INVERTEDPOL          (0x1 <<  8) // (LCDC) Inverted Polarity
+#define AT91C_LCDC_INVFRAME   (0x1 <<  9) // (LCDC) lcd vsync polarity
+#define 	AT91C_LCDC_INVFRAME_NORMALPOL            (0x0 <<  9) // (LCDC) Normal Polarity
+#define 	AT91C_LCDC_INVFRAME_INVERTEDPOL          (0x1 <<  9) // (LCDC) Inverted Polarity
+#define AT91C_LCDC_INVLINE    (0x1 << 10) // (LCDC) lcd hsync polarity
+#define 	AT91C_LCDC_INVLINE_NORMALPOL            (0x0 << 10) // (LCDC) Normal Polarity
+#define 	AT91C_LCDC_INVLINE_INVERTEDPOL          (0x1 << 10) // (LCDC) Inverted Polarity
+#define AT91C_LCDC_INVCLK     (0x1 << 11) // (LCDC) lcd pclk polarity
+#define 	AT91C_LCDC_INVCLK_NORMALPOL            (0x0 << 11) // (LCDC) Normal Polarity
+#define 	AT91C_LCDC_INVCLK_INVERTEDPOL          (0x1 << 11) // (LCDC) Inverted Polarity
+#define AT91C_LCDC_INVDVAL    (0x1 << 12) // (LCDC) lcd dval polarity
+#define 	AT91C_LCDC_INVDVAL_NORMALPOL            (0x0 << 12) // (LCDC) Normal Polarity
+#define 	AT91C_LCDC_INVDVAL_INVERTEDPOL          (0x1 << 12) // (LCDC) Inverted Polarity
+#define AT91C_LCDC_CLKMOD     (0x1 << 15) // (LCDC) lcd pclk Mode
+#define 	AT91C_LCDC_CLKMOD_ACTIVEONLYDISP       (0x0 << 15) // (LCDC) Active during display period
+#define 	AT91C_LCDC_CLKMOD_ALWAYSACTIVE         (0x1 << 15) // (LCDC) Always Active
+#define AT91C_LCDC_MEMOR      (0x3 << 30) // (LCDC) Memory Ordering Format
+#define 	AT91C_LCDC_MEMOR_BIGIND               (0x0 << 30) // (LCDC) Big Endian
+#define 	AT91C_LCDC_MEMOR_LITTLEIND            (0x2 << 30) // (LCDC) Little Endian
+// -------- LCDC_TIM1 : (LCDC Offset: 0x808) LCDC Timing Config 1 Register -------- 
+#define AT91C_LCDC_VFP        (0xFF <<  0) // (LCDC) Vertical Front Porch
+#define AT91C_LCDC_VBP        (0xFF <<  8) // (LCDC) Vertical Back Porch
+#define AT91C_LCDC_VPW        (0x3F << 16) // (LCDC) Vertical Synchronization Pulse Width
+#define AT91C_LCDC_VHDLY      (0xF << 24) // (LCDC) Vertical to Horizontal Delay
+// -------- LCDC_TIM2 : (LCDC Offset: 0x80c) LCDC Timing Config 2 Register -------- 
+#define AT91C_LCDC_HBP        (0xFF <<  0) // (LCDC) Horizontal Back Porch
+#define AT91C_LCDC_HPW        (0x3F <<  8) // (LCDC) Horizontal Synchronization Pulse Width
+#define AT91C_LCDC_HFP        (0x7FF << 21) // (LCDC) Horizontal Front Porch
+// -------- LCDC_LCDFRCFG : (LCDC Offset: 0x810) LCD Frame Config Register -------- 
+#define AT91C_LCDC_LINEVAL    (0x7FF <<  0) // (LCDC) Vertical Size of LCD Module
+#define AT91C_LCDC_HOZVAL     (0x7FF << 21) // (LCDC) Horizontal Size of LCD Module
+// -------- LCDC_FIFO : (LCDC Offset: 0x814) LCD FIFO Register -------- 
+#define AT91C_LCDC_FIFOTH     (0xFFFF <<  0) // (LCDC) FIFO Threshold
+// -------- LCDC_MVAL : (LCDC Offset: 0x818) LCD Mode Toggle Rate Value Register -------- 
+#define AT91C_LCDC_MVALUE     (0xFF <<  0) // (LCDC) Toggle Rate Value
+#define AT91C_LCDC_MMODE      (0x1 << 31) // (LCDC) Toggle Rate Sel
+#define 	AT91C_LCDC_MMODE_EACHFRAME            (0x0 << 31) // (LCDC) Each Frame
+#define 	AT91C_LCDC_MMODE_MVALDEFINED          (0x1 << 31) // (LCDC) Defined by MVAL
+// -------- LCDC_DP1_2 : (LCDC Offset: 0x81c) Dithering Pattern 1/2 -------- 
+#define AT91C_LCDC_DP1_2_FIELD (0xFF <<  0) // (LCDC) Ratio
+// -------- LCDC_DP4_7 : (LCDC Offset: 0x820) Dithering Pattern 4/7 -------- 
+#define AT91C_LCDC_DP4_7_FIELD (0xFFFFFFF <<  0) // (LCDC) Ratio
+// -------- LCDC_DP3_5 : (LCDC Offset: 0x824) Dithering Pattern 3/5 -------- 
+#define AT91C_LCDC_DP3_5_FIELD (0xFFFFF <<  0) // (LCDC) Ratio
+// -------- LCDC_DP2_3 : (LCDC Offset: 0x828) Dithering Pattern 2/3 -------- 
+#define AT91C_LCDC_DP2_3_FIELD (0xFFF <<  0) // (LCDC) Ratio
+// -------- LCDC_DP5_7 : (LCDC Offset: 0x82c) Dithering Pattern 5/7 -------- 
+#define AT91C_LCDC_DP5_7_FIELD (0xFFFFFFF <<  0) // (LCDC) Ratio
+// -------- LCDC_DP3_4 : (LCDC Offset: 0x830) Dithering Pattern 3/4 -------- 
+#define AT91C_LCDC_DP3_4_FIELD (0xFFFF <<  0) // (LCDC) Ratio
+// -------- LCDC_DP4_5 : (LCDC Offset: 0x834) Dithering Pattern 4/5 -------- 
+#define AT91C_LCDC_DP4_5_FIELD (0xFFFFF <<  0) // (LCDC) Ratio
+// -------- LCDC_DP6_7 : (LCDC Offset: 0x838) Dithering Pattern 6/7 -------- 
+#define AT91C_LCDC_DP6_7_FIELD (0xFFFFFFF <<  0) // (LCDC) Ratio
+// -------- LCDC_PWRCON : (LCDC Offset: 0x83c) LCDC Power Control Register -------- 
+#define AT91C_LCDC_PWR        (0x1 <<  0) // (LCDC) LCD Module Power Control
+#define AT91C_LCDC_GUARDT     (0x7F <<  1) // (LCDC) Delay in Frame Period
+#define AT91C_LCDC_BUSY       (0x1 << 31) // (LCDC) Read Only : 1 indicates that LCDC is busy
+#define 	AT91C_LCDC_BUSY_LCDNOTBUSY           (0x0 << 31) // (LCDC) LCD is Not Busy
+#define 	AT91C_LCDC_BUSY_LCDBUSY              (0x1 << 31) // (LCDC) LCD is Busy
+// -------- LCDC_CTRSTCON : (LCDC Offset: 0x840) LCDC Contrast Control Register -------- 
+#define AT91C_LCDC_PS         (0x3 <<  0) // (LCDC) LCD Contrast Counter Prescaler
+#define 	AT91C_LCDC_PS_NOTDIVIDED           (0x0) // (LCDC) Counter Freq is System Freq.
+#define 	AT91C_LCDC_PS_DIVIDEDBYTWO         (0x1) // (LCDC) Counter Freq is System Freq divided by 2.
+#define 	AT91C_LCDC_PS_DIVIDEDBYFOUR        (0x2) // (LCDC) Counter Freq is System Freq divided by 4.
+#define 	AT91C_LCDC_PS_DIVIDEDBYEIGHT       (0x3) // (LCDC) Counter Freq is System Freq divided by 8.
+#define AT91C_LCDC_POL        (0x1 <<  2) // (LCDC) Polarity of output Pulse
+#define 	AT91C_LCDC_POL_NEGATIVEPULSE        (0x0 <<  2) // (LCDC) Negative Pulse
+#define 	AT91C_LCDC_POL_POSITIVEPULSE        (0x1 <<  2) // (LCDC) Positive Pulse
+#define AT91C_LCDC_ENA        (0x1 <<  3) // (LCDC) PWM generator Control
+#define 	AT91C_LCDC_ENA_PWMGEMDISABLED       (0x0 <<  3) // (LCDC) PWM Generator Disabled
+#define 	AT91C_LCDC_ENA_PWMGEMENABLED        (0x1 <<  3) // (LCDC) PWM Generator Disabled
+// -------- LCDC_CTRSTVAL : (LCDC Offset: 0x844) Contrast Value Register -------- 
+#define AT91C_LCDC_CVAL       (0xFF <<  0) // (LCDC) PWM Compare Value
+// -------- LCDC_IER : (LCDC Offset: 0x848) LCDC Interrupt Enable Register -------- 
+#define AT91C_LCDC_LNI        (0x1 <<  0) // (LCDC) Line Interrupt
+#define AT91C_LCDC_LSTLNI     (0x1 <<  1) // (LCDC) Last Line Interrupt
+#define AT91C_LCDC_EOFI       (0x1 <<  2) // (LCDC) End Of Frame Interrupt
+#define AT91C_LCDC_UFLWI      (0x1 <<  4) // (LCDC) FIFO Underflow Interrupt
+#define AT91C_LCDC_OWRI       (0x1 <<  5) // (LCDC) Over Write Interrupt
+#define AT91C_LCDC_MERI       (0x1 <<  6) // (LCDC) Memory Error  Interrupt
+// -------- LCDC_IDR : (LCDC Offset: 0x84c) LCDC Interrupt Disable Register -------- 
+// -------- LCDC_IMR : (LCDC Offset: 0x850) LCDC Interrupt Mask Register -------- 
+// -------- LCDC_ISR : (LCDC Offset: 0x854) LCDC Interrupt Status Register -------- 
+// -------- LCDC_ICR : (LCDC Offset: 0x858) LCDC Interrupt Clear Register -------- 
+// -------- LCDC_GPR : (LCDC Offset: 0x85c) LCDC General Purpose Register -------- 
+#define AT91C_LCDC_GPRBUS     (0xFF <<  0) // (LCDC) 8 bits available
+// -------- LCDC_ITR : (LCDC Offset: 0x860) Interrupts Test Register -------- 
+// -------- LCDC_IRR : (LCDC Offset: 0x864) Interrupts Raw Status Register -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR HDMA Channel structure
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_HDMA_CH {
+	AT91_REG	 HDMA_SADDR; 	// HDMA Channel Source Address Register
+	AT91_REG	 HDMA_DADDR; 	// HDMA Channel Destination Address Register
+	AT91_REG	 HDMA_DSCR; 	// HDMA Channel Descriptor Address Register
+	AT91_REG	 HDMA_CTRLA; 	// HDMA Channel Control A Register
+	AT91_REG	 HDMA_CTRLB; 	// HDMA Channel Control B Register
+	AT91_REG	 HDMA_CFG; 	// HDMA Channel Configuration Register
+	AT91_REG	 HDMA_SPIP; 	// HDMA Channel Source Picture in Picture Configuration Register
+	AT91_REG	 HDMA_DPIP; 	// HDMA Channel Destination Picture in Picture Configuration Register
+	AT91_REG	 HDMA_BDSCR; 	// HDMA Reserved
+	AT91_REG	 HDMA_CADDR; 	// HDMA Reserved
+} AT91S_HDMA_CH, *AT91PS_HDMA_CH;
+#else
+#define HDMA_SADDR      (AT91_CAST(AT91_REG *) 	0x00000000) // (HDMA_SADDR) HDMA Channel Source Address Register
+#define HDMA_DADDR      (AT91_CAST(AT91_REG *) 	0x00000004) // (HDMA_DADDR) HDMA Channel Destination Address Register
+#define HDMA_DSCR       (AT91_CAST(AT91_REG *) 	0x00000008) // (HDMA_DSCR) HDMA Channel Descriptor Address Register
+#define HDMA_CTRLA      (AT91_CAST(AT91_REG *) 	0x0000000C) // (HDMA_CTRLA) HDMA Channel Control A Register
+#define HDMA_CTRLB      (AT91_CAST(AT91_REG *) 	0x00000010) // (HDMA_CTRLB) HDMA Channel Control B Register
+#define HDMA_CFG        (AT91_CAST(AT91_REG *) 	0x00000014) // (HDMA_CFG) HDMA Channel Configuration Register
+#define HDMA_SPIP       (AT91_CAST(AT91_REG *) 	0x00000018) // (HDMA_SPIP) HDMA Channel Source Picture in Picture Configuration Register
+#define HDMA_DPIP       (AT91_CAST(AT91_REG *) 	0x0000001C) // (HDMA_DPIP) HDMA Channel Destination Picture in Picture Configuration Register
+#define HDMA_BDSCR      (AT91_CAST(AT91_REG *) 	0x00000020) // (HDMA_BDSCR) HDMA Reserved
+#define HDMA_CADDR      (AT91_CAST(AT91_REG *) 	0x00000024) // (HDMA_CADDR) HDMA Reserved
+
+#endif
+// -------- HDMA_SADDR : (HDMA_CH Offset: 0x0)  -------- 
+#define AT91C_SADDR           (0x0 <<  0) // (HDMA_CH) 
+// -------- HDMA_DADDR : (HDMA_CH Offset: 0x4)  -------- 
+#define AT91C_DADDR           (0x0 <<  0) // (HDMA_CH) 
+// -------- HDMA_DSCR : (HDMA_CH Offset: 0x8)  -------- 
+#define AT91C_HDMA_DSCR_IF    (0x3 <<  0) // (HDMA_CH) Select AHB-Lite Interface for current channel
+#define 	AT91C_HDMA_DSCR_IF_0                    (0x0) // (HDMA_CH) The Buffer Transfer descriptor is fetched via AHB-Lite Interface 0.
+#define 	AT91C_HDMA_DSCR_IF_1                    (0x1) // (HDMA_CH) The Buffer Transfer descriptor is fetched via AHB-Lite Interface 1.
+#define 	AT91C_HDMA_DSCR_IF_2                    (0x2) // (HDMA_CH) The Buffer Transfer descriptor is fetched via AHB-Lite Interface 2.
+#define 	AT91C_HDMA_DSCR_IF_3                    (0x3) // (HDMA_CH) The Buffer Transfer descriptor is fetched via AHB-Lite Interface 3.
+#define AT91C_HDMA_DSCR       (0x3FFFFFFF <<  2) // (HDMA_CH) Buffer Transfer descriptor address. This address is word aligned.
+// -------- HDMA_CTRLA : (HDMA_CH Offset: 0xc)  -------- 
+#define AT91C_HDMA_BTSIZE     (0xFFFF <<  0) // (HDMA_CH) Buffer Transfer Size.
+#define AT91C_HDMA_SCSIZE     (0x7 << 16) // (HDMA_CH) Source Chunk Transfer Size.
+#define 	AT91C_HDMA_SCSIZE_1                    (0x0 << 16) // (HDMA_CH) 1.
+#define 	AT91C_HDMA_SCSIZE_4                    (0x1 << 16) // (HDMA_CH) 4.
+#define 	AT91C_HDMA_SCSIZE_8                    (0x2 << 16) // (HDMA_CH) 8.
+#define 	AT91C_HDMA_SCSIZE_16                   (0x3 << 16) // (HDMA_CH) 16.
+#define 	AT91C_HDMA_SCSIZE_32                   (0x4 << 16) // (HDMA_CH) 32.
+#define 	AT91C_HDMA_SCSIZE_64                   (0x5 << 16) // (HDMA_CH) 64.
+#define 	AT91C_HDMA_SCSIZE_128                  (0x6 << 16) // (HDMA_CH) 128.
+#define 	AT91C_HDMA_SCSIZE_256                  (0x7 << 16) // (HDMA_CH) 256.
+#define AT91C_HDMA_DCSIZE     (0x7 << 20) // (HDMA_CH) Destination Chunk Transfer Size
+#define 	AT91C_HDMA_DCSIZE_1                    (0x0 << 20) // (HDMA_CH) 1.
+#define 	AT91C_HDMA_DCSIZE_4                    (0x1 << 20) // (HDMA_CH) 4.
+#define 	AT91C_HDMA_DCSIZE_8                    (0x2 << 20) // (HDMA_CH) 8.
+#define 	AT91C_HDMA_DCSIZE_16                   (0x3 << 20) // (HDMA_CH) 16.
+#define 	AT91C_HDMA_DCSIZE_32                   (0x4 << 20) // (HDMA_CH) 32.
+#define 	AT91C_HDMA_DCSIZE_64                   (0x5 << 20) // (HDMA_CH) 64.
+#define 	AT91C_HDMA_DCSIZE_128                  (0x6 << 20) // (HDMA_CH) 128.
+#define 	AT91C_HDMA_DCSIZE_256                  (0x7 << 20) // (HDMA_CH) 256.
+#define AT91C_HDMA_SRC_WIDTH  (0x3 << 24) // (HDMA_CH) Source Single Transfer Size
+#define 	AT91C_HDMA_SRC_WIDTH_BYTE                 (0x0 << 24) // (HDMA_CH) BYTE.
+#define 	AT91C_HDMA_SRC_WIDTH_HALFWORD             (0x1 << 24) // (HDMA_CH) HALF-WORD.
+#define 	AT91C_HDMA_SRC_WIDTH_WORD                 (0x2 << 24) // (HDMA_CH) WORD.
+#define AT91C_HDMA_DST_WIDTH  (0x3 << 28) // (HDMA_CH) Destination Single Transfer Size
+#define 	AT91C_HDMA_DST_WIDTH_BYTE                 (0x0 << 28) // (HDMA_CH) BYTE.
+#define 	AT91C_HDMA_DST_WIDTH_HALFWORD             (0x1 << 28) // (HDMA_CH) HALF-WORD.
+#define 	AT91C_HDMA_DST_WIDTH_WORD                 (0x2 << 28) // (HDMA_CH) WORD.
+#define AT91C_HDMA_DONE       (0x1 << 31) // (HDMA_CH) 
+// -------- HDMA_CTRLB : (HDMA_CH Offset: 0x10)  -------- 
+#define AT91C_HDMA_SIF        (0x3 <<  0) // (HDMA_CH) Source Interface Selection Field.
+#define 	AT91C_HDMA_SIF_0                    (0x0) // (HDMA_CH) The Source Transfer is done via AHB-Lite Interface 0.
+#define 	AT91C_HDMA_SIF_1                    (0x1) // (HDMA_CH) The Source Transfer is done via AHB-Lite Interface 1.
+#define 	AT91C_HDMA_SIF_2                    (0x2) // (HDMA_CH) The Source Transfer is done via AHB-Lite Interface 2.
+#define 	AT91C_HDMA_SIF_3                    (0x3) // (HDMA_CH) The Source Transfer is done via AHB-Lite Interface 3.
+#define AT91C_HDMA_DIF        (0x3 <<  4) // (HDMA_CH) Destination Interface Selection Field.
+#define 	AT91C_HDMA_DIF_0                    (0x0 <<  4) // (HDMA_CH) The Destination Transfer is done via AHB-Lite Interface 0.
+#define 	AT91C_HDMA_DIF_1                    (0x1 <<  4) // (HDMA_CH) The Destination Transfer is done via AHB-Lite Interface 1.
+#define 	AT91C_HDMA_DIF_2                    (0x2 <<  4) // (HDMA_CH) The Destination Transfer is done via AHB-Lite Interface 2.
+#define 	AT91C_HDMA_DIF_3                    (0x3 <<  4) // (HDMA_CH) The Destination Transfer is done via AHB-Lite Interface 3.
+#define AT91C_HDMA_SRC_PIP    (0x1 <<  8) // (HDMA_CH) Source Picture-in-Picture Mode
+#define 	AT91C_HDMA_SRC_PIP_DISABLE              (0x0 <<  8) // (HDMA_CH) Source Picture-in-Picture mode is disabled.
+#define 	AT91C_HDMA_SRC_PIP_ENABLE               (0x1 <<  8) // (HDMA_CH) Source Picture-in-Picture mode is enabled.
+#define AT91C_HDMA_DST_PIP    (0x1 << 12) // (HDMA_CH) Destination Picture-in-Picture Mode
+#define 	AT91C_HDMA_DST_PIP_DISABLE              (0x0 << 12) // (HDMA_CH) Destination Picture-in-Picture mode is disabled.
+#define 	AT91C_HDMA_DST_PIP_ENABLE               (0x1 << 12) // (HDMA_CH) Destination Picture-in-Picture mode is enabled.
+#define AT91C_HDMA_SRC_DSCR   (0x1 << 16) // (HDMA_CH) Source Buffer Descriptor Fetch operation
+#define 	AT91C_HDMA_SRC_DSCR_FETCH_FROM_MEM       (0x0 << 16) // (HDMA_CH) Source address is updated when the descriptor is fetched from the memory.
+#define 	AT91C_HDMA_SRC_DSCR_FETCH_DISABLE        (0x1 << 16) // (HDMA_CH) Buffer Descriptor Fetch operation is disabled for the Source.
+#define AT91C_HDMA_DST_DSCR   (0x1 << 20) // (HDMA_CH) Destination Buffer Descriptor operation
+#define 	AT91C_HDMA_DST_DSCR_FETCH_FROM_MEM       (0x0 << 20) // (HDMA_CH) Destination address is updated when the descriptor is fetched from the memory.
+#define 	AT91C_HDMA_DST_DSCR_FETCH_DISABLE        (0x1 << 20) // (HDMA_CH) Buffer Descriptor Fetch operation is disabled for the destination.
+#define AT91C_HDMA_FC         (0x7 << 21) // (HDMA_CH) This field defines which devices controls the size of the buffer transfer, also referred as to the Flow Controller.
+#define 	AT91C_HDMA_FC_MEM2MEM              (0x0 << 21) // (HDMA_CH) Memory-to-Memory (DMA Controller).
+#define 	AT91C_HDMA_FC_MEM2PER              (0x1 << 21) // (HDMA_CH) Memory-to-Peripheral (DMA Controller).
+#define 	AT91C_HDMA_FC_PER2MEM              (0x2 << 21) // (HDMA_CH) Peripheral-to-Memory (DMA Controller).
+#define 	AT91C_HDMA_FC_PER2PER              (0x3 << 21) // (HDMA_CH) Peripheral-to-Peripheral (DMA Controller).
+#define 	AT91C_HDMA_FC_PER2MEM_PER          (0x4 << 21) // (HDMA_CH) Peripheral-to-Memory (Peripheral).
+#define 	AT91C_HDMA_FC_MEM2PER_PER          (0x5 << 21) // (HDMA_CH) Memory-to-Peripheral (Peripheral).
+#define 	AT91C_HDMA_FC_PER2PER_PER          (0x6 << 21) // (HDMA_CH) Peripheral-to-Peripheral (Source Peripheral).
+#define AT91C_HDMA_SRC_ADDRESS_MODE (0x3 << 24) // (HDMA_CH) Type of addressing mode
+#define 	AT91C_HDMA_SRC_ADDRESS_MODE_INCR                 (0x0 << 24) // (HDMA_CH) Incrementing Mode.
+#define 	AT91C_HDMA_SRC_ADDRESS_MODE_DECR                 (0x1 << 24) // (HDMA_CH) Decrementing Mode.
+#define 	AT91C_HDMA_SRC_ADDRESS_MODE_FIXED                (0x2 << 24) // (HDMA_CH) Fixed Mode.
+#define AT91C_HDMA_DST_ADDRESS_MODE (0x3 << 28) // (HDMA_CH) Type of addressing mode
+#define 	AT91C_HDMA_DST_ADDRESS_MODE_INCR                 (0x0 << 28) // (HDMA_CH) Incrementing Mode.
+#define 	AT91C_HDMA_DST_ADDRESS_MODE_DECR                 (0x1 << 28) // (HDMA_CH) Decrementing Mode.
+#define 	AT91C_HDMA_DST_ADDRESS_MODE_FIXED                (0x2 << 28) // (HDMA_CH) Fixed Mode.
+#define AT91C_HDMA_AUTO       (0x1 << 31) // (HDMA_CH) Automatic multiple buffer transfer enable
+#define 	AT91C_HDMA_AUTO_DISABLE              (0x0 << 31) // (HDMA_CH) Automatic multiple buffer transfer is disabled.
+#define 	AT91C_HDMA_AUTO_ENABLE               (0x1 << 31) // (HDMA_CH) Automatic multiple buffer transfer is enabled. This enables replay mode or contiguous mode when several buffers are transferred.
+// -------- HDMA_CFG : (HDMA_CH Offset: 0x14)  -------- 
+#define AT91C_HDMA_SRC_PER    (0xF <<  0) // (HDMA_CH) Channel Source Request is associated with peripheral identifier coded SRC_PER handshaking interface.
+#define 	AT91C_HDMA_SRC_PER_0                    (0x0) // (HDMA_CH) HW Handshaking Interface number 0.
+#define 	AT91C_HDMA_SRC_PER_1                    (0x1) // (HDMA_CH) HW Handshaking Interface number 1.
+#define 	AT91C_HDMA_SRC_PER_2                    (0x2) // (HDMA_CH) HW Handshaking Interface number 2.
+#define 	AT91C_HDMA_SRC_PER_3                    (0x3) // (HDMA_CH) HW Handshaking Interface number 3.
+#define 	AT91C_HDMA_SRC_PER_4                    (0x4) // (HDMA_CH) HW Handshaking Interface number 4.
+#define 	AT91C_HDMA_SRC_PER_5                    (0x5) // (HDMA_CH) HW Handshaking Interface number 5.
+#define 	AT91C_HDMA_SRC_PER_6                    (0x6) // (HDMA_CH) HW Handshaking Interface number 6.
+#define 	AT91C_HDMA_SRC_PER_7                    (0x7) // (HDMA_CH) HW Handshaking Interface number 7.
+#define 	AT91C_HDMA_SRC_PER_8                    (0x8) // (HDMA_CH) HW Handshaking Interface number 8.
+#define 	AT91C_HDMA_SRC_PER_9                    (0x9) // (HDMA_CH) HW Handshaking Interface number 9.
+#define 	AT91C_HDMA_SRC_PER_10                   (0xA) // (HDMA_CH) HW Handshaking Interface number 10.
+#define 	AT91C_HDMA_SRC_PER_11                   (0xB) // (HDMA_CH) HW Handshaking Interface number 11.
+#define 	AT91C_HDMA_SRC_PER_12                   (0xC) // (HDMA_CH) HW Handshaking Interface number 12.
+#define 	AT91C_HDMA_SRC_PER_13                   (0xD) // (HDMA_CH) HW Handshaking Interface number 13.
+#define 	AT91C_HDMA_SRC_PER_14                   (0xE) // (HDMA_CH) HW Handshaking Interface number 14.
+#define 	AT91C_HDMA_SRC_PER_15                   (0xF) // (HDMA_CH) HW Handshaking Interface number 15.
+#define AT91C_HDMA_DST_PER    (0xF <<  4) // (HDMA_CH) Channel Destination Request is associated with peripheral identifier coded DST_PER handshaking interface.
+#define 	AT91C_HDMA_DST_PER_0                    (0x0 <<  4) // (HDMA_CH) HW Handshaking Interface number 0.
+#define 	AT91C_HDMA_DST_PER_1                    (0x1 <<  4) // (HDMA_CH) HW Handshaking Interface number 1.
+#define 	AT91C_HDMA_DST_PER_2                    (0x2 <<  4) // (HDMA_CH) HW Handshaking Interface number 2.
+#define 	AT91C_HDMA_DST_PER_3                    (0x3 <<  4) // (HDMA_CH) HW Handshaking Interface number 3.
+#define 	AT91C_HDMA_DST_PER_4                    (0x4 <<  4) // (HDMA_CH) HW Handshaking Interface number 4.
+#define 	AT91C_HDMA_DST_PER_5                    (0x5 <<  4) // (HDMA_CH) HW Handshaking Interface number 5.
+#define 	AT91C_HDMA_DST_PER_6                    (0x6 <<  4) // (HDMA_CH) HW Handshaking Interface number 6.
+#define 	AT91C_HDMA_DST_PER_7                    (0x7 <<  4) // (HDMA_CH) HW Handshaking Interface number 7.
+#define 	AT91C_HDMA_DST_PER_8                    (0x8 <<  4) // (HDMA_CH) HW Handshaking Interface number 8.
+#define 	AT91C_HDMA_DST_PER_9                    (0x9 <<  4) // (HDMA_CH) HW Handshaking Interface number 9.
+#define 	AT91C_HDMA_DST_PER_10                   (0xA <<  4) // (HDMA_CH) HW Handshaking Interface number 10.
+#define 	AT91C_HDMA_DST_PER_11                   (0xB <<  4) // (HDMA_CH) HW Handshaking Interface number 11.
+#define 	AT91C_HDMA_DST_PER_12                   (0xC <<  4) // (HDMA_CH) HW Handshaking Interface number 12.
+#define 	AT91C_HDMA_DST_PER_13                   (0xD <<  4) // (HDMA_CH) HW Handshaking Interface number 13.
+#define 	AT91C_HDMA_DST_PER_14                   (0xE <<  4) // (HDMA_CH) HW Handshaking Interface number 14.
+#define 	AT91C_HDMA_DST_PER_15                   (0xF <<  4) // (HDMA_CH) HW Handshaking Interface number 15.
+#define AT91C_HDMA_SRC_REP    (0x1 <<  8) // (HDMA_CH) Source Replay Mode
+#define 	AT91C_HDMA_SRC_REP_CONTIGUOUS_ADDR      (0x0 <<  8) // (HDMA_CH) When automatic mode is activated, source address is contiguous between two buffers.
+#define 	AT91C_HDMA_SRC_REP_RELOAD_ADDR          (0x1 <<  8) // (HDMA_CH) When automatic mode is activated, the source address and the control register are reloaded from previous transfer..
+#define AT91C_HDMA_SRC_H2SEL  (0x1 <<  9) // (HDMA_CH) Source Handshaking Mode
+#define 	AT91C_HDMA_SRC_H2SEL_SW                   (0x0 <<  9) // (HDMA_CH) Software handshaking interface is used to trigger a transfer request.
+#define 	AT91C_HDMA_SRC_H2SEL_HW                   (0x1 <<  9) // (HDMA_CH) Hardware handshaking interface is used to trigger a transfer request.
+#define AT91C_HDMA_DST_REP    (0x1 << 12) // (HDMA_CH) Destination Replay Mode
+#define 	AT91C_HDMA_DST_REP_CONTIGUOUS_ADDR      (0x0 << 12) // (HDMA_CH) When automatic mode is activated, destination address is contiguous between two buffers.
+#define 	AT91C_HDMA_DST_REP_RELOAD_ADDR          (0x1 << 12) // (HDMA_CH) When automatic mode is activated, the destination address and the control register are reloaded from previous transfer..
+#define AT91C_HDMA_DST_H2SEL  (0x1 << 13) // (HDMA_CH) Destination Handshaking Mode
+#define 	AT91C_HDMA_DST_H2SEL_SW                   (0x0 << 13) // (HDMA_CH) Software handshaking interface is used to trigger a transfer request.
+#define 	AT91C_HDMA_DST_H2SEL_HW                   (0x1 << 13) // (HDMA_CH) Hardware handshaking interface is used to trigger a transfer request.
+#define AT91C_HDMA_SOD        (0x1 << 16) // (HDMA_CH) STOP ON DONE
+#define 	AT91C_HDMA_SOD_DISABLE              (0x0 << 16) // (HDMA_CH) STOP ON DONE disabled, the descriptor fetch operation ignores DONE Field of CTRLA register.
+#define 	AT91C_HDMA_SOD_ENABLE               (0x1 << 16) // (HDMA_CH) STOP ON DONE activated, the DMAC module is automatically disabled if DONE FIELD is set to 1.
+#define AT91C_HDMA_LOCK_IF    (0x1 << 20) // (HDMA_CH) Interface Lock
+#define 	AT91C_HDMA_LOCK_IF_DISABLE              (0x0 << 20) // (HDMA_CH) Interface Lock capability is disabled.
+#define 	AT91C_HDMA_LOCK_IF_ENABLE               (0x1 << 20) // (HDMA_CH) Interface Lock capability is enabled.
+#define AT91C_HDMA_LOCK_B     (0x1 << 21) // (HDMA_CH) AHB Bus Lock
+#define 	AT91C_HDMA_LOCK_B_DISABLE              (0x0 << 21) // (HDMA_CH) AHB Bus Locking capability is disabled.
+#define 	AT91C_HDMA_LOCK_B_ENABLE               (0x1 << 21) // (HDMA_CH) AHB Bus Locking capability is enabled.
+#define AT91C_HDMA_LOCK_IF_L  (0x1 << 22) // (HDMA_CH) Master Interface Arbiter Lock
+#define 	AT91C_HDMA_LOCK_IF_L_CHUNK                (0x0 << 22) // (HDMA_CH) The Master Interface Arbiter is locked by the channel x for a chunk transfer.
+#define 	AT91C_HDMA_LOCK_IF_L_BUFFER               (0x1 << 22) // (HDMA_CH) The Master Interface Arbiter is locked by the channel x for a buffer transfer.
+#define AT91C_HDMA_AHB_PROT   (0x7 << 24) // (HDMA_CH) AHB Prot
+#define AT91C_HDMA_FIFOCFG    (0x3 << 28) // (HDMA_CH) FIFO Request Configuration
+#define 	AT91C_HDMA_FIFOCFG_LARGESTBURST         (0x0 << 28) // (HDMA_CH) The largest defined length AHB burst is performed on the destination AHB interface.
+#define 	AT91C_HDMA_FIFOCFG_HALFFIFO             (0x1 << 28) // (HDMA_CH) When half fifo size is available/filled a source/destination request is serviced.
+#define 	AT91C_HDMA_FIFOCFG_ENOUGHSPACE          (0x2 << 28) // (HDMA_CH) When there is enough space/data available to perfom a single AHB access then the request is serviced.
+// -------- HDMA_SPIP : (HDMA_CH Offset: 0x18)  -------- 
+#define AT91C_SPIP_HOLE       (0xFFFF <<  0) // (HDMA_CH) This field indicates the value to add to the address when the programmable boundary has been reached.
+#define AT91C_SPIP_BOUNDARY   (0x3FF << 16) // (HDMA_CH) This field indicates the number of source transfers to perform before the automatic address increment operation.
+// -------- HDMA_DPIP : (HDMA_CH Offset: 0x1c)  -------- 
+#define AT91C_DPIP_HOLE       (0xFFFF <<  0) // (HDMA_CH) This field indicates the value to add to the address when the programmable boundary has been reached.
+#define AT91C_DPIP_BOUNDARY   (0x3FF << 16) // (HDMA_CH) This field indicates the number of source transfers to perform before the automatic address increment operation.
+// -------- HDMA_BDSCR : (HDMA_CH Offset: 0x20)  -------- 
+// -------- HDMA_CADDR : (HDMA_CH Offset: 0x24)  -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR HDMA controller
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_HDMA {
+	AT91_REG	 HDMA_GCFG; 	// HDMA Global Configuration Register
+	AT91_REG	 HDMA_EN; 	// HDMA Controller Enable Register
+	AT91_REG	 HDMA_SREQ; 	// HDMA Software Single Request Register
+	AT91_REG	 HDMA_CREQ; 	// HDMA Software Chunk Transfer Request Register
+	AT91_REG	 HDMA_LAST; 	// HDMA Software Last Transfer Flag Register
+	AT91_REG	 HDMA_SYNC; 	// HDMA Request Synchronization Register
+	AT91_REG	 HDMA_EBCIER; 	// HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Interrupt Enable register
+	AT91_REG	 HDMA_EBCIDR; 	// HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Interrupt Disable register
+	AT91_REG	 HDMA_EBCIMR; 	// HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Mask Register
+	AT91_REG	 HDMA_EBCISR; 	// HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Status Register
+	AT91_REG	 HDMA_CHER; 	// HDMA Channel Handler Enable Register
+	AT91_REG	 HDMA_CHDR; 	// HDMA Channel Handler Disable Register
+	AT91_REG	 HDMA_CHSR; 	// HDMA Channel Handler Status Register
+	AT91_REG	 HDMA_RSVD0; 	// HDMA Reserved
+	AT91_REG	 HDMA_RSVD1; 	// HDMA Reserved
+	AT91S_HDMA_CH	 HDMA_CH[8]; 	// HDMA Channel structure
+} AT91S_HDMA, *AT91PS_HDMA;
+#else
+#define HDMA_GCFG       (AT91_CAST(AT91_REG *) 	0x00000000) // (HDMA_GCFG) HDMA Global Configuration Register
+#define HDMA_EN         (AT91_CAST(AT91_REG *) 	0x00000004) // (HDMA_EN) HDMA Controller Enable Register
+#define HDMA_SREQ       (AT91_CAST(AT91_REG *) 	0x00000008) // (HDMA_SREQ) HDMA Software Single Request Register
+#define HDMA_CREQ       (AT91_CAST(AT91_REG *) 	0x0000000C) // (HDMA_CREQ) HDMA Software Chunk Transfer Request Register
+#define HDMA_LAST       (AT91_CAST(AT91_REG *) 	0x00000010) // (HDMA_LAST) HDMA Software Last Transfer Flag Register
+#define HDMA_SYNC       (AT91_CAST(AT91_REG *) 	0x00000014) // (HDMA_SYNC) HDMA Request Synchronization Register
+#define HDMA_EBCIER     (AT91_CAST(AT91_REG *) 	0x00000018) // (HDMA_EBCIER) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Interrupt Enable register
+#define HDMA_EBCIDR     (AT91_CAST(AT91_REG *) 	0x0000001C) // (HDMA_EBCIDR) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Interrupt Disable register
+#define HDMA_EBCIMR     (AT91_CAST(AT91_REG *) 	0x00000020) // (HDMA_EBCIMR) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Mask Register
+#define HDMA_EBCISR     (AT91_CAST(AT91_REG *) 	0x00000024) // (HDMA_EBCISR) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Status Register
+#define HDMA_CHER       (AT91_CAST(AT91_REG *) 	0x00000028) // (HDMA_CHER) HDMA Channel Handler Enable Register
+#define HDMA_CHDR       (AT91_CAST(AT91_REG *) 	0x0000002C) // (HDMA_CHDR) HDMA Channel Handler Disable Register
+#define HDMA_CHSR       (AT91_CAST(AT91_REG *) 	0x00000030) // (HDMA_CHSR) HDMA Channel Handler Status Register
+#define HDMA_RSVD0      (AT91_CAST(AT91_REG *) 	0x00000034) // (HDMA_RSVD0) HDMA Reserved
+#define HDMA_RSVD1      (AT91_CAST(AT91_REG *) 	0x00000038) // (HDMA_RSVD1) HDMA Reserved
+
+#endif
+// -------- HDMA_GCFG : (HDMA Offset: 0x0)  -------- 
+#define AT91C_HDMA_IF0_BIGEND (0x1 <<  0) // (HDMA) AHB-Lite Interface 0 endian mode.
+#define 	AT91C_HDMA_IF0_BIGEND_IS_LITTLE_ENDIAN     (0x0) // (HDMA) AHB-Lite Interface 0 is little endian.
+#define 	AT91C_HDMA_IF0_BIGEND_IS_BIG_ENDIAN        (0x1) // (HDMA) AHB-Lite Interface 0 is big endian.
+#define AT91C_HDMA_IF1_BIGEND (0x1 <<  1) // (HDMA) AHB-Lite Interface 1 endian mode.
+#define 	AT91C_HDMA_IF1_BIGEND_IS_LITTLE_ENDIAN     (0x0 <<  1) // (HDMA) AHB-Lite Interface 1 is little endian.
+#define 	AT91C_HDMA_IF1_BIGEND_IS_BIG_ENDIAN        (0x1 <<  1) // (HDMA) AHB-Lite Interface 1 is big endian.
+#define AT91C_HDMA_IF2_BIGEND (0x1 <<  2) // (HDMA) AHB-Lite Interface 2 endian mode.
+#define 	AT91C_HDMA_IF2_BIGEND_IS_LITTLE_ENDIAN     (0x0 <<  2) // (HDMA) AHB-Lite Interface 2 is little endian.
+#define 	AT91C_HDMA_IF2_BIGEND_IS_BIG_ENDIAN        (0x1 <<  2) // (HDMA) AHB-Lite Interface 2 is big endian.
+#define AT91C_HDMA_IF3_BIGEND (0x1 <<  3) // (HDMA) AHB-Lite Interface 3 endian mode.
+#define 	AT91C_HDMA_IF3_BIGEND_IS_LITTLE_ENDIAN     (0x0 <<  3) // (HDMA) AHB-Lite Interface 3 is little endian.
+#define 	AT91C_HDMA_IF3_BIGEND_IS_BIG_ENDIAN        (0x1 <<  3) // (HDMA) AHB-Lite Interface 3 is big endian.
+#define AT91C_HDMA_ARB_CFG    (0x1 <<  4) // (HDMA) Arbiter mode.
+#define 	AT91C_HDMA_ARB_CFG_FIXED                (0x0 <<  4) // (HDMA) Fixed priority arbiter.
+#define 	AT91C_HDMA_ARB_CFG_ROUND_ROBIN          (0x1 <<  4) // (HDMA) Modified round robin arbiter.
+// -------- HDMA_EN : (HDMA Offset: 0x4)  -------- 
+#define AT91C_HDMA_ENABLE     (0x1 <<  0) // (HDMA) 
+#define 	AT91C_HDMA_ENABLE_DISABLE              (0x0) // (HDMA) Disables HDMA.
+#define 	AT91C_HDMA_ENABLE_ENABLE               (0x1) // (HDMA) Enables HDMA.
+// -------- HDMA_SREQ : (HDMA Offset: 0x8)  -------- 
+#define AT91C_HDMA_SSREQ0     (0x1 <<  0) // (HDMA) Request a source single transfer on channel 0
+#define 	AT91C_HDMA_SSREQ0_0                    (0x0) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ0_1                    (0x1) // (HDMA) Request a source single transfer on channel 0.
+#define AT91C_HDMA_DSREQ0     (0x1 <<  1) // (HDMA) Request a destination single transfer on channel 0
+#define 	AT91C_HDMA_DSREQ0_0                    (0x0 <<  1) // (HDMA) No effect.
+#define 	AT91C_HDMA_DSREQ0_1                    (0x1 <<  1) // (HDMA) Request a destination single transfer on channel 0.
+#define AT91C_HDMA_SSREQ1     (0x1 <<  2) // (HDMA) Request a source single transfer on channel 1
+#define 	AT91C_HDMA_SSREQ1_0                    (0x0 <<  2) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ1_1                    (0x1 <<  2) // (HDMA) Request a source single transfer on channel 1.
+#define AT91C_HDMA_DSREQ1     (0x1 <<  3) // (HDMA) Request a destination single transfer on channel 1
+#define 	AT91C_HDMA_DSREQ1_0                    (0x0 <<  3) // (HDMA) No effect.
+#define 	AT91C_HDMA_DSREQ1_1                    (0x1 <<  3) // (HDMA) Request a destination single transfer on channel 1.
+#define AT91C_HDMA_SSREQ2     (0x1 <<  4) // (HDMA) Request a source single transfer on channel 2
+#define 	AT91C_HDMA_SSREQ2_0                    (0x0 <<  4) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ2_1                    (0x1 <<  4) // (HDMA) Request a source single transfer on channel 2.
+#define AT91C_HDMA_DSREQ2     (0x1 <<  5) // (HDMA) Request a destination single transfer on channel 2
+#define 	AT91C_HDMA_DSREQ2_0                    (0x0 <<  5) // (HDMA) No effect.
+#define 	AT91C_HDMA_DSREQ2_1                    (0x1 <<  5) // (HDMA) Request a destination single transfer on channel 2.
+#define AT91C_HDMA_SSREQ3     (0x1 <<  6) // (HDMA) Request a source single transfer on channel 3
+#define 	AT91C_HDMA_SSREQ3_0                    (0x0 <<  6) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ3_1                    (0x1 <<  6) // (HDMA) Request a source single transfer on channel 3.
+#define AT91C_HDMA_DSREQ3     (0x1 <<  7) // (HDMA) Request a destination single transfer on channel 3
+#define 	AT91C_HDMA_DSREQ3_0                    (0x0 <<  7) // (HDMA) No effect.
+#define 	AT91C_HDMA_DSREQ3_1                    (0x1 <<  7) // (HDMA) Request a destination single transfer on channel 3.
+#define AT91C_HDMA_SSREQ4     (0x1 <<  8) // (HDMA) Request a source single transfer on channel 4
+#define 	AT91C_HDMA_SSREQ4_0                    (0x0 <<  8) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ4_1                    (0x1 <<  8) // (HDMA) Request a source single transfer on channel 4.
+#define AT91C_HDMA_DSREQ4     (0x1 <<  9) // (HDMA) Request a destination single transfer on channel 4
+#define 	AT91C_HDMA_DSREQ4_0                    (0x0 <<  9) // (HDMA) No effect.
+#define 	AT91C_HDMA_DSREQ4_1                    (0x1 <<  9) // (HDMA) Request a destination single transfer on channel 4.
+#define AT91C_HDMA_SSREQ5     (0x1 << 10) // (HDMA) Request a source single transfer on channel 5
+#define 	AT91C_HDMA_SSREQ5_0                    (0x0 << 10) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ5_1                    (0x1 << 10) // (HDMA) Request a source single transfer on channel 5.
+#define AT91C_HDMA_DSREQ6     (0x1 << 11) // (HDMA) Request a destination single transfer on channel 5
+#define 	AT91C_HDMA_DSREQ6_0                    (0x0 << 11) // (HDMA) No effect.
+#define 	AT91C_HDMA_DSREQ6_1                    (0x1 << 11) // (HDMA) Request a destination single transfer on channel 5.
+#define AT91C_HDMA_SSREQ6     (0x1 << 12) // (HDMA) Request a source single transfer on channel 6
+#define 	AT91C_HDMA_SSREQ6_0                    (0x0 << 12) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ6_1                    (0x1 << 12) // (HDMA) Request a source single transfer on channel 6.
+#define AT91C_HDMA_SSREQ7     (0x1 << 14) // (HDMA) Request a source single transfer on channel 7
+#define 	AT91C_HDMA_SSREQ7_0                    (0x0 << 14) // (HDMA) No effect.
+#define 	AT91C_HDMA_SSREQ7_1                    (0x1 << 14) // (HDMA) Request a source single transfer on channel 7.
+#define AT91C_HDMA_DSREQ7     (0x1 << 15) // (HDMA) Request a destination single transfer on channel 7
+#define 	AT91C_HDMA_DSREQ7_0                    (0x0 << 15) // (HDMA) No effect.
+#define 	AT91C_HDMA_DSREQ7_1                    (0x1 << 15) // (HDMA) Request a destination single transfer on channel 7.
+// -------- HDMA_CREQ : (HDMA Offset: 0xc)  -------- 
+#define AT91C_HDMA_SCREQ0     (0x1 <<  0) // (HDMA) Request a source chunk transfer on channel 0
+#define 	AT91C_HDMA_SCREQ0_0                    (0x0) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ0_1                    (0x1) // (HDMA) Request a source chunk transfer on channel 0.
+#define AT91C_HDMA_DCREQ0     (0x1 <<  1) // (HDMA) Request a destination chunk transfer on channel 0
+#define 	AT91C_HDMA_DCREQ0_0                    (0x0 <<  1) // (HDMA) No effect.
+#define 	AT91C_HDMA_DCREQ0_1                    (0x1 <<  1) // (HDMA) Request a destination chunk transfer on channel 0.
+#define AT91C_HDMA_SCREQ1     (0x1 <<  2) // (HDMA) Request a source chunk transfer on channel 1
+#define 	AT91C_HDMA_SCREQ1_0                    (0x0 <<  2) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ1_1                    (0x1 <<  2) // (HDMA) Request a source chunk transfer on channel 1.
+#define AT91C_HDMA_DCREQ1     (0x1 <<  3) // (HDMA) Request a destination chunk transfer on channel 1
+#define 	AT91C_HDMA_DCREQ1_0                    (0x0 <<  3) // (HDMA) No effect.
+#define 	AT91C_HDMA_DCREQ1_1                    (0x1 <<  3) // (HDMA) Request a destination chunk transfer on channel 1.
+#define AT91C_HDMA_SCREQ2     (0x1 <<  4) // (HDMA) Request a source chunk transfer on channel 2
+#define 	AT91C_HDMA_SCREQ2_0                    (0x0 <<  4) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ2_1                    (0x1 <<  4) // (HDMA) Request a source chunk transfer on channel 2.
+#define AT91C_HDMA_DCREQ2     (0x1 <<  5) // (HDMA) Request a destination chunk transfer on channel 2
+#define 	AT91C_HDMA_DCREQ2_0                    (0x0 <<  5) // (HDMA) No effect.
+#define 	AT91C_HDMA_DCREQ2_1                    (0x1 <<  5) // (HDMA) Request a destination chunk transfer on channel 2.
+#define AT91C_HDMA_SCREQ3     (0x1 <<  6) // (HDMA) Request a source chunk transfer on channel 3
+#define 	AT91C_HDMA_SCREQ3_0                    (0x0 <<  6) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ3_1                    (0x1 <<  6) // (HDMA) Request a source chunk transfer on channel 3.
+#define AT91C_HDMA_DCREQ3     (0x1 <<  7) // (HDMA) Request a destination chunk transfer on channel 3
+#define 	AT91C_HDMA_DCREQ3_0                    (0x0 <<  7) // (HDMA) No effect.
+#define 	AT91C_HDMA_DCREQ3_1                    (0x1 <<  7) // (HDMA) Request a destination chunk transfer on channel 3.
+#define AT91C_HDMA_SCREQ4     (0x1 <<  8) // (HDMA) Request a source chunk transfer on channel 4
+#define 	AT91C_HDMA_SCREQ4_0                    (0x0 <<  8) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ4_1                    (0x1 <<  8) // (HDMA) Request a source chunk transfer on channel 4.
+#define AT91C_HDMA_DCREQ4     (0x1 <<  9) // (HDMA) Request a destination chunk transfer on channel 4
+#define 	AT91C_HDMA_DCREQ4_0                    (0x0 <<  9) // (HDMA) No effect.
+#define 	AT91C_HDMA_DCREQ4_1                    (0x1 <<  9) // (HDMA) Request a destination chunk transfer on channel 4.
+#define AT91C_HDMA_SCREQ5     (0x1 << 10) // (HDMA) Request a source chunk transfer on channel 5
+#define 	AT91C_HDMA_SCREQ5_0                    (0x0 << 10) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ5_1                    (0x1 << 10) // (HDMA) Request a source chunk transfer on channel 5.
+#define AT91C_HDMA_DCREQ6     (0x1 << 11) // (HDMA) Request a destination chunk transfer on channel 5
+#define 	AT91C_HDMA_DCREQ6_0                    (0x0 << 11) // (HDMA) No effect.
+#define 	AT91C_HDMA_DCREQ6_1                    (0x1 << 11) // (HDMA) Request a destination chunk transfer on channel 5.
+#define AT91C_HDMA_SCREQ6     (0x1 << 12) // (HDMA) Request a source chunk transfer on channel 6
+#define 	AT91C_HDMA_SCREQ6_0                    (0x0 << 12) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ6_1                    (0x1 << 12) // (HDMA) Request a source chunk transfer on channel 6.
+#define AT91C_HDMA_SCREQ7     (0x1 << 14) // (HDMA) Request a source chunk transfer on channel 7
+#define 	AT91C_HDMA_SCREQ7_0                    (0x0 << 14) // (HDMA) No effect.
+#define 	AT91C_HDMA_SCREQ7_1                    (0x1 << 14) // (HDMA) Request a source chunk transfer on channel 7.
+#define AT91C_HDMA_DCREQ7     (0x1 << 15) // (HDMA) Request a destination chunk transfer on channel 7
+#define 	AT91C_HDMA_DCREQ7_0                    (0x0 << 15) // (HDMA) No effect.
+#define 	AT91C_HDMA_DCREQ7_1                    (0x1 << 15) // (HDMA) Request a destination chunk transfer on channel 7.
+// -------- HDMA_LAST : (HDMA Offset: 0x10)  -------- 
+#define AT91C_HDMA_SLAST0     (0x1 <<  0) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 0
+#define 	AT91C_HDMA_SLAST0_0                    (0x0) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST0_1                    (0x1) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 0.
+#define AT91C_HDMA_DLAST0     (0x1 <<  1) // (HDMA) Indicates that this destination request is the last transfer of the buffer on channel 0
+#define 	AT91C_HDMA_DLAST0_0                    (0x0 <<  1) // (HDMA) No effect.
+#define 	AT91C_HDMA_DLAST0_1                    (0x1 <<  1) // (HDMA) Writing one to DLASTx prior to writing one to DSREQx or DCREQx indicates that this destination request is the last transfer of the buffer on channel 0.
+#define AT91C_HDMA_SLAST1     (0x1 <<  2) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 1
+#define 	AT91C_HDMA_SLAST1_0                    (0x0 <<  2) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST1_1                    (0x1 <<  2) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 1.
+#define AT91C_HDMA_DLAST1     (0x1 <<  3) // (HDMA) Indicates that this destination request is the last transfer of the buffer on channel 1
+#define 	AT91C_HDMA_DLAST1_0                    (0x0 <<  3) // (HDMA) No effect.
+#define 	AT91C_HDMA_DLAST1_1                    (0x1 <<  3) // (HDMA) Writing one to DLASTx prior to writing one to DSREQx or DCREQx indicates that this destination request is the last transfer of the buffer on channel 1.
+#define AT91C_HDMA_SLAST2     (0x1 <<  4) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 2
+#define 	AT91C_HDMA_SLAST2_0                    (0x0 <<  4) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST2_1                    (0x1 <<  4) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 2.
+#define AT91C_HDMA_DLAST2     (0x1 <<  5) // (HDMA) Indicates that this destination request is the last transfer of the buffer on channel 2
+#define 	AT91C_HDMA_DLAST2_0                    (0x0 <<  5) // (HDMA) No effect.
+#define 	AT91C_HDMA_DLAST2_1                    (0x1 <<  5) // (HDMA) Writing one to DLASTx prior to writing one to DSREQx or DCREQx indicates that this destination request is the last transfer of the buffer on channel 2.
+#define AT91C_HDMA_SLAST3     (0x1 <<  6) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 3
+#define 	AT91C_HDMA_SLAST3_0                    (0x0 <<  6) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST3_1                    (0x1 <<  6) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 3.
+#define AT91C_HDMA_DLAST3     (0x1 <<  7) // (HDMA) Indicates that this destination request is the last transfer of the buffer on channel 3
+#define 	AT91C_HDMA_DLAST3_0                    (0x0 <<  7) // (HDMA) No effect.
+#define 	AT91C_HDMA_DLAST3_1                    (0x1 <<  7) // (HDMA) Writing one to DLASTx prior to writing one to DSREQx or DCREQx indicates that this destination request is the last transfer of the buffer on channel 3.
+#define AT91C_HDMA_SLAST4     (0x1 <<  8) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 4
+#define 	AT91C_HDMA_SLAST4_0                    (0x0 <<  8) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST4_1                    (0x1 <<  8) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 4.
+#define AT91C_HDMA_DLAST4     (0x1 <<  9) // (HDMA) Indicates that this destination request is the last transfer of the buffer on channel 4
+#define 	AT91C_HDMA_DLAST4_0                    (0x0 <<  9) // (HDMA) No effect.
+#define 	AT91C_HDMA_DLAST4_1                    (0x1 <<  9) // (HDMA) Writing one to DLASTx prior to writing one to DSREQx or DCREQx indicates that this destination request is the last transfer of the buffer on channel 4.
+#define AT91C_HDMA_SLAST5     (0x1 << 10) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 5
+#define 	AT91C_HDMA_SLAST5_0                    (0x0 << 10) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST5_1                    (0x1 << 10) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 5.
+#define AT91C_HDMA_DLAST6     (0x1 << 11) // (HDMA) Indicates that this destination request is the last transfer of the buffer on channel 5
+#define 	AT91C_HDMA_DLAST6_0                    (0x0 << 11) // (HDMA) No effect.
+#define 	AT91C_HDMA_DLAST6_1                    (0x1 << 11) // (HDMA) Writing one to DLASTx prior to writing one to DSREQx or DCREQx indicates that this destination request is the last transfer of the buffer on channel 5.
+#define AT91C_HDMA_SLAST6     (0x1 << 12) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 6
+#define 	AT91C_HDMA_SLAST6_0                    (0x0 << 12) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST6_1                    (0x1 << 12) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 6.
+#define AT91C_HDMA_SLAST7     (0x1 << 14) // (HDMA) Indicates that this source request is the last transfer of the buffer on channel 7
+#define 	AT91C_HDMA_SLAST7_0                    (0x0 << 14) // (HDMA) No effect.
+#define 	AT91C_HDMA_SLAST7_1                    (0x1 << 14) // (HDMA) Writing one to SLASTx prior to writing one to SSREQx or SCREQx indicates that this source request is the last transfer of the buffer on channel 7.
+#define AT91C_HDMA_DLAST7     (0x1 << 15) // (HDMA) Indicates that this destination request is the last transfer of the buffer on channel 7
+#define 	AT91C_HDMA_DLAST7_0                    (0x0 << 15) // (HDMA) No effect.
+#define 	AT91C_HDMA_DLAST7_1                    (0x1 << 15) // (HDMA) Writing one to DLASTx prior to writing one to DSREQx or DCREQx indicates that this destination request is the last transfer of the buffer on channel 7.
+// -------- HDMA_SYNC : (HDMA Offset: 0x14)  -------- 
+#define AT91C_SYNC_REQ        (0xFFFF <<  0) // (HDMA) 
+// -------- HDMA_EBCIER : (HDMA Offset: 0x18) Buffer Transfer Completed/Chained Buffer Transfer Completed/Access Error Interrupt Enable Register -------- 
+#define AT91C_HDMA_BTC0       (0x1 <<  0) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_BTC1       (0x1 <<  1) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_BTC2       (0x1 <<  2) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_BTC3       (0x1 <<  3) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_BTC4       (0x1 <<  4) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_BTC5       (0x1 <<  5) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_BTC6       (0x1 <<  6) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_BTC7       (0x1 <<  7) // (HDMA) Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC0      (0x1 <<  8) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC1      (0x1 <<  9) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC2      (0x1 << 10) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC3      (0x1 << 11) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC4      (0x1 << 12) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC5      (0x1 << 13) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC6      (0x1 << 14) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_CBTC7      (0x1 << 15) // (HDMA) Chained Buffer Transfer Completed Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR0       (0x1 << 16) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR1       (0x1 << 17) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR2       (0x1 << 18) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR3       (0x1 << 19) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR4       (0x1 << 20) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR5       (0x1 << 21) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR6       (0x1 << 22) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+#define AT91C_HDMA_ERR7       (0x1 << 23) // (HDMA) Access HDMA_Error Interrupt Enable/Disable/Status Register
+// -------- HDMA_EBCIDR : (HDMA Offset: 0x1c)  -------- 
+// -------- HDMA_EBCIMR : (HDMA Offset: 0x20)  -------- 
+// -------- HDMA_EBCISR : (HDMA Offset: 0x24)  -------- 
+// -------- HDMA_CHER : (HDMA Offset: 0x28)  -------- 
+#define AT91C_HDMA_ENA0       (0x1 <<  0) // (HDMA) When set, channel 0 enabled.
+#define 	AT91C_HDMA_ENA0_0                    (0x0) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA0_1                    (0x1) // (HDMA) Channel 0 enabled.
+#define AT91C_HDMA_ENA1       (0x1 <<  1) // (HDMA) When set, channel 1 enabled.
+#define 	AT91C_HDMA_ENA1_0                    (0x0 <<  1) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA1_1                    (0x1 <<  1) // (HDMA) Channel 1 enabled.
+#define AT91C_HDMA_ENA2       (0x1 <<  2) // (HDMA) When set, channel 2 enabled.
+#define 	AT91C_HDMA_ENA2_0                    (0x0 <<  2) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA2_1                    (0x1 <<  2) // (HDMA) Channel 2 enabled.
+#define AT91C_HDMA_ENA3       (0x1 <<  3) // (HDMA) When set, channel 3 enabled.
+#define 	AT91C_HDMA_ENA3_0                    (0x0 <<  3) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA3_1                    (0x1 <<  3) // (HDMA) Channel 3 enabled.
+#define AT91C_HDMA_ENA4       (0x1 <<  4) // (HDMA) When set, channel 4 enabled.
+#define 	AT91C_HDMA_ENA4_0                    (0x0 <<  4) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA4_1                    (0x1 <<  4) // (HDMA) Channel 4 enabled.
+#define AT91C_HDMA_ENA5       (0x1 <<  5) // (HDMA) When set, channel 5 enabled.
+#define 	AT91C_HDMA_ENA5_0                    (0x0 <<  5) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA5_1                    (0x1 <<  5) // (HDMA) Channel 5 enabled.
+#define AT91C_HDMA_ENA6       (0x1 <<  6) // (HDMA) When set, channel 6 enabled.
+#define 	AT91C_HDMA_ENA6_0                    (0x0 <<  6) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA6_1                    (0x1 <<  6) // (HDMA) Channel 6 enabled.
+#define AT91C_HDMA_ENA7       (0x1 <<  7) // (HDMA) When set, channel 7 enabled.
+#define 	AT91C_HDMA_ENA7_0                    (0x0 <<  7) // (HDMA) No effect.
+#define 	AT91C_HDMA_ENA7_1                    (0x1 <<  7) // (HDMA) Channel 7 enabled.
+#define AT91C_HDMA_SUSP0      (0x1 <<  8) // (HDMA) When set, channel 0 freezed and its current context.
+#define 	AT91C_HDMA_SUSP0_0                    (0x0 <<  8) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP0_1                    (0x1 <<  8) // (HDMA) Channel 0 freezed.
+#define AT91C_HDMA_SUSP1      (0x1 <<  9) // (HDMA) When set, channel 1 freezed and its current context.
+#define 	AT91C_HDMA_SUSP1_0                    (0x0 <<  9) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP1_1                    (0x1 <<  9) // (HDMA) Channel 1 freezed.
+#define AT91C_HDMA_SUSP2      (0x1 << 10) // (HDMA) When set, channel 2 freezed and its current context.
+#define 	AT91C_HDMA_SUSP2_0                    (0x0 << 10) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP2_1                    (0x1 << 10) // (HDMA) Channel 2 freezed.
+#define AT91C_HDMA_SUSP3      (0x1 << 11) // (HDMA) When set, channel 3 freezed and its current context.
+#define 	AT91C_HDMA_SUSP3_0                    (0x0 << 11) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP3_1                    (0x1 << 11) // (HDMA) Channel 3 freezed.
+#define AT91C_HDMA_SUSP4      (0x1 << 12) // (HDMA) When set, channel 4 freezed and its current context.
+#define 	AT91C_HDMA_SUSP4_0                    (0x0 << 12) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP4_1                    (0x1 << 12) // (HDMA) Channel 4 freezed.
+#define AT91C_HDMA_SUSP5      (0x1 << 13) // (HDMA) When set, channel 5 freezed and its current context.
+#define 	AT91C_HDMA_SUSP5_0                    (0x0 << 13) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP5_1                    (0x1 << 13) // (HDMA) Channel 5 freezed.
+#define AT91C_HDMA_SUSP6      (0x1 << 14) // (HDMA) When set, channel 6 freezed and its current context.
+#define 	AT91C_HDMA_SUSP6_0                    (0x0 << 14) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP6_1                    (0x1 << 14) // (HDMA) Channel 6 freezed.
+#define AT91C_HDMA_SUSP7      (0x1 << 15) // (HDMA) When set, channel 7 freezed and its current context.
+#define 	AT91C_HDMA_SUSP7_0                    (0x0 << 15) // (HDMA) No effect.
+#define 	AT91C_HDMA_SUSP7_1                    (0x1 << 15) // (HDMA) Channel 7 freezed.
+#define AT91C_HDMA_KEEP0      (0x1 << 24) // (HDMA) When set, it resumes the channel 0 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP0_0                    (0x0 << 24) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP0_1                    (0x1 << 24) // (HDMA) Resumes the channel 0.
+#define AT91C_HDMA_KEEP1      (0x1 << 25) // (HDMA) When set, it resumes the channel 1 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP1_0                    (0x0 << 25) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP1_1                    (0x1 << 25) // (HDMA) Resumes the channel 1.
+#define AT91C_HDMA_KEEP2      (0x1 << 26) // (HDMA) When set, it resumes the channel 2 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP2_0                    (0x0 << 26) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP2_1                    (0x1 << 26) // (HDMA) Resumes the channel 2.
+#define AT91C_HDMA_KEEP3      (0x1 << 27) // (HDMA) When set, it resumes the channel 3 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP3_0                    (0x0 << 27) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP3_1                    (0x1 << 27) // (HDMA) Resumes the channel 3.
+#define AT91C_HDMA_KEEP4      (0x1 << 28) // (HDMA) When set, it resumes the channel 4 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP4_0                    (0x0 << 28) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP4_1                    (0x1 << 28) // (HDMA) Resumes the channel 4.
+#define AT91C_HDMA_KEEP5      (0x1 << 29) // (HDMA) When set, it resumes the channel 5 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP5_0                    (0x0 << 29) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP5_1                    (0x1 << 29) // (HDMA) Resumes the channel 5.
+#define AT91C_HDMA_KEEP6      (0x1 << 30) // (HDMA) When set, it resumes the channel 6 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP6_0                    (0x0 << 30) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP6_1                    (0x1 << 30) // (HDMA) Resumes the channel 6.
+#define AT91C_HDMA_KEEP7      (0x1 << 31) // (HDMA) When set, it resumes the channel 7 from an automatic stall state.
+#define 	AT91C_HDMA_KEEP7_0                    (0x0 << 31) // (HDMA) No effect.
+#define 	AT91C_HDMA_KEEP7_1                    (0x1 << 31) // (HDMA) Resumes the channel 7.
+// -------- HDMA_CHDR : (HDMA Offset: 0x2c)  -------- 
+#define AT91C_HDMA_DIS0       (0x1 <<  0) // (HDMA) Write one to this field to disable the channel 0.
+#define 	AT91C_HDMA_DIS0_0                    (0x0) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS0_1                    (0x1) // (HDMA) Disables the channel 0.
+#define AT91C_HDMA_DIS1       (0x1 <<  1) // (HDMA) Write one to this field to disable the channel 1.
+#define 	AT91C_HDMA_DIS1_0                    (0x0 <<  1) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS1_1                    (0x1 <<  1) // (HDMA) Disables the channel 1.
+#define AT91C_HDMA_DIS2       (0x1 <<  2) // (HDMA) Write one to this field to disable the channel 2.
+#define 	AT91C_HDMA_DIS2_0                    (0x0 <<  2) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS2_1                    (0x1 <<  2) // (HDMA) Disables the channel 2.
+#define AT91C_HDMA_DIS3       (0x1 <<  3) // (HDMA) Write one to this field to disable the channel 3.
+#define 	AT91C_HDMA_DIS3_0                    (0x0 <<  3) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS3_1                    (0x1 <<  3) // (HDMA) Disables the channel 3.
+#define AT91C_HDMA_DIS4       (0x1 <<  4) // (HDMA) Write one to this field to disable the channel 4.
+#define 	AT91C_HDMA_DIS4_0                    (0x0 <<  4) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS4_1                    (0x1 <<  4) // (HDMA) Disables the channel 4.
+#define AT91C_HDMA_DIS5       (0x1 <<  5) // (HDMA) Write one to this field to disable the channel 5.
+#define 	AT91C_HDMA_DIS5_0                    (0x0 <<  5) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS5_1                    (0x1 <<  5) // (HDMA) Disables the channel 5.
+#define AT91C_HDMA_DIS6       (0x1 <<  6) // (HDMA) Write one to this field to disable the channel 6.
+#define 	AT91C_HDMA_DIS6_0                    (0x0 <<  6) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS6_1                    (0x1 <<  6) // (HDMA) Disables the channel 6.
+#define AT91C_HDMA_DIS7       (0x1 <<  7) // (HDMA) Write one to this field to disable the channel 7.
+#define 	AT91C_HDMA_DIS7_0                    (0x0 <<  7) // (HDMA) No effect.
+#define 	AT91C_HDMA_DIS7_1                    (0x1 <<  7) // (HDMA) Disables the channel 7.
+#define AT91C_HDMA_RES0       (0x1 <<  8) // (HDMA) Write one to this field to resume the channel 0 transfer restoring its context.
+#define 	AT91C_HDMA_RES0_0                    (0x0 <<  8) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES0_1                    (0x1 <<  8) // (HDMA) Resumes the channel 0.
+#define AT91C_HDMA_RES1       (0x1 <<  9) // (HDMA) Write one to this field to resume the channel 1 transfer restoring its context.
+#define 	AT91C_HDMA_RES1_0                    (0x0 <<  9) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES1_1                    (0x1 <<  9) // (HDMA) Resumes the channel 1.
+#define AT91C_HDMA_RES2       (0x1 << 10) // (HDMA) Write one to this field to resume the channel 2 transfer restoring its context.
+#define 	AT91C_HDMA_RES2_0                    (0x0 << 10) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES2_1                    (0x1 << 10) // (HDMA) Resumes the channel 2.
+#define AT91C_HDMA_RES3       (0x1 << 11) // (HDMA) Write one to this field to resume the channel 3 transfer restoring its context.
+#define 	AT91C_HDMA_RES3_0                    (0x0 << 11) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES3_1                    (0x1 << 11) // (HDMA) Resumes the channel 3.
+#define AT91C_HDMA_RES4       (0x1 << 12) // (HDMA) Write one to this field to resume the channel 4 transfer restoring its context.
+#define 	AT91C_HDMA_RES4_0                    (0x0 << 12) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES4_1                    (0x1 << 12) // (HDMA) Resumes the channel 4.
+#define AT91C_HDMA_RES5       (0x1 << 13) // (HDMA) Write one to this field to resume the channel 5 transfer restoring its context.
+#define 	AT91C_HDMA_RES5_0                    (0x0 << 13) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES5_1                    (0x1 << 13) // (HDMA) Resumes the channel 5.
+#define AT91C_HDMA_RES6       (0x1 << 14) // (HDMA) Write one to this field to resume the channel 6 transfer restoring its context.
+#define 	AT91C_HDMA_RES6_0                    (0x0 << 14) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES6_1                    (0x1 << 14) // (HDMA) Resumes the channel 6.
+#define AT91C_HDMA_RES7       (0x1 << 15) // (HDMA) Write one to this field to resume the channel 7 transfer restoring its context.
+#define 	AT91C_HDMA_RES7_0                    (0x0 << 15) // (HDMA) No effect.
+#define 	AT91C_HDMA_RES7_1                    (0x1 << 15) // (HDMA) Resumes the channel 7.
+// -------- HDMA_CHSR : (HDMA Offset: 0x30)  -------- 
+#define AT91C_HDMA_EMPT0      (0x1 << 16) // (HDMA) When set, channel 0 is empty.
+#define 	AT91C_HDMA_EMPT0_0                    (0x0 << 16) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT0_1                    (0x1 << 16) // (HDMA) Channel 0 empty.
+#define AT91C_HDMA_EMPT1      (0x1 << 17) // (HDMA) When set, channel 1 is empty.
+#define 	AT91C_HDMA_EMPT1_0                    (0x0 << 17) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT1_1                    (0x1 << 17) // (HDMA) Channel 1 empty.
+#define AT91C_HDMA_EMPT2      (0x1 << 18) // (HDMA) When set, channel 2 is empty.
+#define 	AT91C_HDMA_EMPT2_0                    (0x0 << 18) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT2_1                    (0x1 << 18) // (HDMA) Channel 2 empty.
+#define AT91C_HDMA_EMPT3      (0x1 << 19) // (HDMA) When set, channel 3 is empty.
+#define 	AT91C_HDMA_EMPT3_0                    (0x0 << 19) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT3_1                    (0x1 << 19) // (HDMA) Channel 3 empty.
+#define AT91C_HDMA_EMPT4      (0x1 << 20) // (HDMA) When set, channel 4 is empty.
+#define 	AT91C_HDMA_EMPT4_0                    (0x0 << 20) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT4_1                    (0x1 << 20) // (HDMA) Channel 4 empty.
+#define AT91C_HDMA_EMPT5      (0x1 << 21) // (HDMA) When set, channel 5 is empty.
+#define 	AT91C_HDMA_EMPT5_0                    (0x0 << 21) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT5_1                    (0x1 << 21) // (HDMA) Channel 5 empty.
+#define AT91C_HDMA_EMPT6      (0x1 << 22) // (HDMA) When set, channel 6 is empty.
+#define 	AT91C_HDMA_EMPT6_0                    (0x0 << 22) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT6_1                    (0x1 << 22) // (HDMA) Channel 6 empty.
+#define AT91C_HDMA_EMPT7      (0x1 << 23) // (HDMA) When set, channel 7 is empty.
+#define 	AT91C_HDMA_EMPT7_0                    (0x0 << 23) // (HDMA) No effect.
+#define 	AT91C_HDMA_EMPT7_1                    (0x1 << 23) // (HDMA) Channel 7 empty.
+#define AT91C_HDMA_STAL0      (0x1 << 24) // (HDMA) When set, channel 0 is stalled.
+#define 	AT91C_HDMA_STAL0_0                    (0x0 << 24) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL0_1                    (0x1 << 24) // (HDMA) Channel 0 stalled.
+#define AT91C_HDMA_STAL1      (0x1 << 25) // (HDMA) When set, channel 1 is stalled.
+#define 	AT91C_HDMA_STAL1_0                    (0x0 << 25) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL1_1                    (0x1 << 25) // (HDMA) Channel 1 stalled.
+#define AT91C_HDMA_STAL2      (0x1 << 26) // (HDMA) When set, channel 2 is stalled.
+#define 	AT91C_HDMA_STAL2_0                    (0x0 << 26) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL2_1                    (0x1 << 26) // (HDMA) Channel 2 stalled.
+#define AT91C_HDMA_STAL3      (0x1 << 27) // (HDMA) When set, channel 3 is stalled.
+#define 	AT91C_HDMA_STAL3_0                    (0x0 << 27) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL3_1                    (0x1 << 27) // (HDMA) Channel 3 stalled.
+#define AT91C_HDMA_STAL4      (0x1 << 28) // (HDMA) When set, channel 4 is stalled.
+#define 	AT91C_HDMA_STAL4_0                    (0x0 << 28) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL4_1                    (0x1 << 28) // (HDMA) Channel 4 stalled.
+#define AT91C_HDMA_STAL5      (0x1 << 29) // (HDMA) When set, channel 5 is stalled.
+#define 	AT91C_HDMA_STAL5_0                    (0x0 << 29) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL5_1                    (0x1 << 29) // (HDMA) Channel 5 stalled.
+#define AT91C_HDMA_STAL6      (0x1 << 30) // (HDMA) When set, channel 6 is stalled.
+#define 	AT91C_HDMA_STAL6_0                    (0x0 << 30) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL6_1                    (0x1 << 30) // (HDMA) Channel 6 stalled.
+#define AT91C_HDMA_STAL7      (0x1 << 31) // (HDMA) When set, channel 7 is stalled.
+#define 	AT91C_HDMA_STAL7_0                    (0x0 << 31) // (HDMA) No effect.
+#define 	AT91C_HDMA_STAL7_1                    (0x1 << 31) // (HDMA) Channel 7 stalled.
+// -------- HDMA_RSVD : (HDMA Offset: 0x34)  -------- 
+// -------- HDMA_RSVD : (HDMA Offset: 0x38)  -------- 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Error Correction Code controller
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_ECC {
+	AT91_REG	 ECC_CR; 	//  ECC reset register
+	AT91_REG	 ECC_MR; 	//  ECC Page size register
+	AT91_REG	 ECC_SR; 	//  ECC Status register
+	AT91_REG	 ECC_PR; 	//  ECC Parity register
+	AT91_REG	 ECC_NPR; 	//  ECC Parity N register
+	AT91_REG	 Reserved0[58]; 	// 
+	AT91_REG	 ECC_VR; 	//  ECC Version register
+} AT91S_ECC, *AT91PS_ECC;
+#else
+#define ECC_CR          (AT91_CAST(AT91_REG *) 	0x00000000) // (ECC_CR)  ECC reset register
+#define ECC_MR          (AT91_CAST(AT91_REG *) 	0x00000004) // (ECC_MR)  ECC Page size register
+#define ECC_SR          (AT91_CAST(AT91_REG *) 	0x00000008) // (ECC_SR)  ECC Status register
+#define ECC_PR          (AT91_CAST(AT91_REG *) 	0x0000000C) // (ECC_PR)  ECC Parity register
+#define ECC_NPR         (AT91_CAST(AT91_REG *) 	0x00000010) // (ECC_NPR)  ECC Parity N register
+#define ECC_VR          (AT91_CAST(AT91_REG *) 	0x000000FC) // (ECC_VR)  ECC Version register
+
+#endif
+// -------- ECC_CR : (ECC Offset: 0x0) ECC reset register -------- 
+#define AT91C_ECC_RST         (0x1 <<  0) // (ECC) ECC reset parity
+// -------- ECC_MR : (ECC Offset: 0x4) ECC page size register -------- 
+#define AT91C_ECC_PAGE_SIZE   (0x3 <<  0) // (ECC) Nand Flash page size
+// -------- ECC_SR : (ECC Offset: 0x8) ECC status register -------- 
+#define AT91C_ECC_RECERR      (0x1 <<  0) // (ECC) ECC error
+#define AT91C_ECC_ECCERR      (0x1 <<  1) // (ECC) ECC single error
+#define AT91C_ECC_MULERR      (0x1 <<  2) // (ECC) ECC_MULERR
+// -------- ECC_PR : (ECC Offset: 0xc) ECC parity register -------- 
+#define AT91C_ECC_BITADDR     (0xF <<  0) // (ECC) Bit address error
+#define AT91C_ECC_WORDADDR    (0xFFF <<  4) // (ECC) address of the failing bit
+// -------- ECC_NPR : (ECC Offset: 0x10) ECC N parity register -------- 
+#define AT91C_ECC_NPARITY     (0xFFFF <<  0) // (ECC) ECC parity N 
+// -------- ECC_VR : (ECC Offset: 0xfc) ECC version register -------- 
+#define AT91C_ECC_VR          (0xF <<  0) // (ECC) ECC version register
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Ethernet MAC 10/100
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_EMAC {
+	AT91_REG	 EMAC_NCR; 	// Network Control Register
+	AT91_REG	 EMAC_NCFGR; 	// Network Configuration Register
+	AT91_REG	 EMAC_NSR; 	// Network Status Register
+	AT91_REG	 Reserved0[2]; 	// 
+	AT91_REG	 EMAC_TSR; 	// Transmit Status Register
+	AT91_REG	 EMAC_RBQP; 	// Receive Buffer Queue Pointer
+	AT91_REG	 EMAC_TBQP; 	// Transmit Buffer Queue Pointer
+	AT91_REG	 EMAC_RSR; 	// Receive Status Register
+	AT91_REG	 EMAC_ISR; 	// Interrupt Status Register
+	AT91_REG	 EMAC_IER; 	// Interrupt Enable Register
+	AT91_REG	 EMAC_IDR; 	// Interrupt Disable Register
+	AT91_REG	 EMAC_IMR; 	// Interrupt Mask Register
+	AT91_REG	 EMAC_MAN; 	// PHY Maintenance Register
+	AT91_REG	 EMAC_PTR; 	// Pause Time Register
+	AT91_REG	 EMAC_PFR; 	// Pause Frames received Register
+	AT91_REG	 EMAC_FTO; 	// Frames Transmitted OK Register
+	AT91_REG	 EMAC_SCF; 	// Single Collision Frame Register
+	AT91_REG	 EMAC_MCF; 	// Multiple Collision Frame Register
+	AT91_REG	 EMAC_FRO; 	// Frames Received OK Register
+	AT91_REG	 EMAC_FCSE; 	// Frame Check Sequence Error Register
+	AT91_REG	 EMAC_ALE; 	// Alignment Error Register
+	AT91_REG	 EMAC_DTF; 	// Deferred Transmission Frame Register
+	AT91_REG	 EMAC_LCOL; 	// Late Collision Register
+	AT91_REG	 EMAC_ECOL; 	// Excessive Collision Register
+	AT91_REG	 EMAC_TUND; 	// Transmit Underrun Error Register
+	AT91_REG	 EMAC_CSE; 	// Carrier Sense Error Register
+	AT91_REG	 EMAC_RRE; 	// Receive Ressource Error Register
+	AT91_REG	 EMAC_ROV; 	// Receive Overrun Errors Register
+	AT91_REG	 EMAC_RSE; 	// Receive Symbol Errors Register
+	AT91_REG	 EMAC_ELE; 	// Excessive Length Errors Register
+	AT91_REG	 EMAC_RJA; 	// Receive Jabbers Register
+	AT91_REG	 EMAC_USF; 	// Undersize Frames Register
+	AT91_REG	 EMAC_STE; 	// SQE Test Error Register
+	AT91_REG	 EMAC_RLE; 	// Receive Length Field Mismatch Register
+	AT91_REG	 EMAC_TPF; 	// Transmitted Pause Frames Register
+	AT91_REG	 EMAC_HRB; 	// Hash Address Bottom[31:0]
+	AT91_REG	 EMAC_HRT; 	// Hash Address Top[63:32]
+	AT91_REG	 EMAC_SA1L; 	// Specific Address 1 Bottom, First 4 bytes
+	AT91_REG	 EMAC_SA1H; 	// Specific Address 1 Top, Last 2 bytes
+	AT91_REG	 EMAC_SA2L; 	// Specific Address 2 Bottom, First 4 bytes
+	AT91_REG	 EMAC_SA2H; 	// Specific Address 2 Top, Last 2 bytes
+	AT91_REG	 EMAC_SA3L; 	// Specific Address 3 Bottom, First 4 bytes
+	AT91_REG	 EMAC_SA3H; 	// Specific Address 3 Top, Last 2 bytes
+	AT91_REG	 EMAC_SA4L; 	// Specific Address 4 Bottom, First 4 bytes
+	AT91_REG	 EMAC_SA4H; 	// Specific Address 4 Top, Last 2 bytes
+	AT91_REG	 EMAC_TID; 	// Type ID Checking Register
+	AT91_REG	 EMAC_TPQ; 	// Transmit Pause Quantum Register
+	AT91_REG	 EMAC_USRIO; 	// USER Input/Output Register
+	AT91_REG	 EMAC_WOL; 	// Wake On LAN Register
+	AT91_REG	 Reserved1[13]; 	// 
+	AT91_REG	 EMAC_REV; 	// Revision Register
+} AT91S_EMAC, *AT91PS_EMAC;
+#else
+#define EMAC_NCR        (AT91_CAST(AT91_REG *) 	0x00000000) // (EMAC_NCR) Network Control Register
+#define EMAC_NCFGR      (AT91_CAST(AT91_REG *) 	0x00000004) // (EMAC_NCFGR) Network Configuration Register
+#define EMAC_NSR        (AT91_CAST(AT91_REG *) 	0x00000008) // (EMAC_NSR) Network Status Register
+#define EMAC_TSR        (AT91_CAST(AT91_REG *) 	0x00000014) // (EMAC_TSR) Transmit Status Register
+#define EMAC_RBQP       (AT91_CAST(AT91_REG *) 	0x00000018) // (EMAC_RBQP) Receive Buffer Queue Pointer
+#define EMAC_TBQP       (AT91_CAST(AT91_REG *) 	0x0000001C) // (EMAC_TBQP) Transmit Buffer Queue Pointer
+#define EMAC_RSR        (AT91_CAST(AT91_REG *) 	0x00000020) // (EMAC_RSR) Receive Status Register
+#define EMAC_ISR        (AT91_CAST(AT91_REG *) 	0x00000024) // (EMAC_ISR) Interrupt Status Register
+#define EMAC_IER        (AT91_CAST(AT91_REG *) 	0x00000028) // (EMAC_IER) Interrupt Enable Register
+#define EMAC_IDR        (AT91_CAST(AT91_REG *) 	0x0000002C) // (EMAC_IDR) Interrupt Disable Register
+#define EMAC_IMR        (AT91_CAST(AT91_REG *) 	0x00000030) // (EMAC_IMR) Interrupt Mask Register
+#define EMAC_MAN        (AT91_CAST(AT91_REG *) 	0x00000034) // (EMAC_MAN) PHY Maintenance Register
+#define EMAC_PTR        (AT91_CAST(AT91_REG *) 	0x00000038) // (EMAC_PTR) Pause Time Register
+#define EMAC_PFR        (AT91_CAST(AT91_REG *) 	0x0000003C) // (EMAC_PFR) Pause Frames received Register
+#define EMAC_FTO        (AT91_CAST(AT91_REG *) 	0x00000040) // (EMAC_FTO) Frames Transmitted OK Register
+#define EMAC_SCF        (AT91_CAST(AT91_REG *) 	0x00000044) // (EMAC_SCF) Single Collision Frame Register
+#define EMAC_MCF        (AT91_CAST(AT91_REG *) 	0x00000048) // (EMAC_MCF) Multiple Collision Frame Register
+#define EMAC_FRO        (AT91_CAST(AT91_REG *) 	0x0000004C) // (EMAC_FRO) Frames Received OK Register
+#define EMAC_FCSE       (AT91_CAST(AT91_REG *) 	0x00000050) // (EMAC_FCSE) Frame Check Sequence Error Register
+#define EMAC_ALE        (AT91_CAST(AT91_REG *) 	0x00000054) // (EMAC_ALE) Alignment Error Register
+#define EMAC_DTF        (AT91_CAST(AT91_REG *) 	0x00000058) // (EMAC_DTF) Deferred Transmission Frame Register
+#define EMAC_LCOL       (AT91_CAST(AT91_REG *) 	0x0000005C) // (EMAC_LCOL) Late Collision Register
+#define EMAC_ECOL       (AT91_CAST(AT91_REG *) 	0x00000060) // (EMAC_ECOL) Excessive Collision Register
+#define EMAC_TUND       (AT91_CAST(AT91_REG *) 	0x00000064) // (EMAC_TUND) Transmit Underrun Error Register
+#define EMAC_CSE        (AT91_CAST(AT91_REG *) 	0x00000068) // (EMAC_CSE) Carrier Sense Error Register
+#define EMAC_RRE        (AT91_CAST(AT91_REG *) 	0x0000006C) // (EMAC_RRE) Receive Ressource Error Register
+#define EMAC_ROV        (AT91_CAST(AT91_REG *) 	0x00000070) // (EMAC_ROV) Receive Overrun Errors Register
+#define EMAC_RSE        (AT91_CAST(AT91_REG *) 	0x00000074) // (EMAC_RSE) Receive Symbol Errors Register
+#define EMAC_ELE        (AT91_CAST(AT91_REG *) 	0x00000078) // (EMAC_ELE) Excessive Length Errors Register
+#define EMAC_RJA        (AT91_CAST(AT91_REG *) 	0x0000007C) // (EMAC_RJA) Receive Jabbers Register
+#define EMAC_USF        (AT91_CAST(AT91_REG *) 	0x00000080) // (EMAC_USF) Undersize Frames Register
+#define EMAC_STE        (AT91_CAST(AT91_REG *) 	0x00000084) // (EMAC_STE) SQE Test Error Register
+#define EMAC_RLE        (AT91_CAST(AT91_REG *) 	0x00000088) // (EMAC_RLE) Receive Length Field Mismatch Register
+#define EMAC_TPF        (AT91_CAST(AT91_REG *) 	0x0000008C) // (EMAC_TPF) Transmitted Pause Frames Register
+#define EMAC_HRB        (AT91_CAST(AT91_REG *) 	0x00000090) // (EMAC_HRB) Hash Address Bottom[31:0]
+#define EMAC_HRT        (AT91_CAST(AT91_REG *) 	0x00000094) // (EMAC_HRT) Hash Address Top[63:32]
+#define EMAC_SA1L       (AT91_CAST(AT91_REG *) 	0x00000098) // (EMAC_SA1L) Specific Address 1 Bottom, First 4 bytes
+#define EMAC_SA1H       (AT91_CAST(AT91_REG *) 	0x0000009C) // (EMAC_SA1H) Specific Address 1 Top, Last 2 bytes
+#define EMAC_SA2L       (AT91_CAST(AT91_REG *) 	0x000000A0) // (EMAC_SA2L) Specific Address 2 Bottom, First 4 bytes
+#define EMAC_SA2H       (AT91_CAST(AT91_REG *) 	0x000000A4) // (EMAC_SA2H) Specific Address 2 Top, Last 2 bytes
+#define EMAC_SA3L       (AT91_CAST(AT91_REG *) 	0x000000A8) // (EMAC_SA3L) Specific Address 3 Bottom, First 4 bytes
+#define EMAC_SA3H       (AT91_CAST(AT91_REG *) 	0x000000AC) // (EMAC_SA3H) Specific Address 3 Top, Last 2 bytes
+#define EMAC_SA4L       (AT91_CAST(AT91_REG *) 	0x000000B0) // (EMAC_SA4L) Specific Address 4 Bottom, First 4 bytes
+#define EMAC_SA4H       (AT91_CAST(AT91_REG *) 	0x000000B4) // (EMAC_SA4H) Specific Address 4 Top, Last 2 bytes
+#define EMAC_TID        (AT91_CAST(AT91_REG *) 	0x000000B8) // (EMAC_TID) Type ID Checking Register
+#define EMAC_TPQ        (AT91_CAST(AT91_REG *) 	0x000000BC) // (EMAC_TPQ) Transmit Pause Quantum Register
+#define EMAC_USRIO      (AT91_CAST(AT91_REG *) 	0x000000C0) // (EMAC_USRIO) USER Input/Output Register
+#define EMAC_WOL        (AT91_CAST(AT91_REG *) 	0x000000C4) // (EMAC_WOL) Wake On LAN Register
+#define EMAC_REV        (AT91_CAST(AT91_REG *) 	0x000000FC) // (EMAC_REV) Revision Register
+
+#endif
+// -------- EMAC_NCR : (EMAC Offset: 0x0)  -------- 
+#define AT91C_EMAC_LB         (0x1 <<  0) // (EMAC) Loopback. Optional. When set, loopback signal is at high level.
+#define AT91C_EMAC_LLB        (0x1 <<  1) // (EMAC) Loopback local. 
+#define AT91C_EMAC_RE         (0x1 <<  2) // (EMAC) Receive enable. 
+#define AT91C_EMAC_TE         (0x1 <<  3) // (EMAC) Transmit enable. 
+#define AT91C_EMAC_MPE        (0x1 <<  4) // (EMAC) Management port enable. 
+#define AT91C_EMAC_CLRSTAT    (0x1 <<  5) // (EMAC) Clear statistics registers. 
+#define AT91C_EMAC_INCSTAT    (0x1 <<  6) // (EMAC) Increment statistics registers. 
+#define AT91C_EMAC_WESTAT     (0x1 <<  7) // (EMAC) Write enable for statistics registers. 
+#define AT91C_EMAC_BP         (0x1 <<  8) // (EMAC) Back pressure. 
+#define AT91C_EMAC_TSTART     (0x1 <<  9) // (EMAC) Start Transmission. 
+#define AT91C_EMAC_THALT      (0x1 << 10) // (EMAC) Transmission Halt. 
+#define AT91C_EMAC_TPFR       (0x1 << 11) // (EMAC) Transmit pause frame 
+#define AT91C_EMAC_TZQ        (0x1 << 12) // (EMAC) Transmit zero quantum pause frame
+// -------- EMAC_NCFGR : (EMAC Offset: 0x4) Network Configuration Register -------- 
+#define AT91C_EMAC_SPD        (0x1 <<  0) // (EMAC) Speed. 
+#define AT91C_EMAC_FD         (0x1 <<  1) // (EMAC) Full duplex. 
+#define AT91C_EMAC_JFRAME     (0x1 <<  3) // (EMAC) Jumbo Frames. 
+#define AT91C_EMAC_CAF        (0x1 <<  4) // (EMAC) Copy all frames. 
+#define AT91C_EMAC_NBC        (0x1 <<  5) // (EMAC) No broadcast. 
+#define AT91C_EMAC_MTI        (0x1 <<  6) // (EMAC) Multicast hash event enable
+#define AT91C_EMAC_UNI        (0x1 <<  7) // (EMAC) Unicast hash enable. 
+#define AT91C_EMAC_BIG        (0x1 <<  8) // (EMAC) Receive 1522 bytes. 
+#define AT91C_EMAC_EAE        (0x1 <<  9) // (EMAC) External address match enable. 
+#define AT91C_EMAC_CLK        (0x3 << 10) // (EMAC) 
+#define 	AT91C_EMAC_CLK_HCLK_8               (0x0 << 10) // (EMAC) HCLK divided by 8
+#define 	AT91C_EMAC_CLK_HCLK_16              (0x1 << 10) // (EMAC) HCLK divided by 16
+#define 	AT91C_EMAC_CLK_HCLK_32              (0x2 << 10) // (EMAC) HCLK divided by 32
+#define 	AT91C_EMAC_CLK_HCLK_64              (0x3 << 10) // (EMAC) HCLK divided by 64
+#define AT91C_EMAC_RTY        (0x1 << 12) // (EMAC) 
+#define AT91C_EMAC_PAE        (0x1 << 13) // (EMAC) 
+#define AT91C_EMAC_RBOF       (0x3 << 14) // (EMAC) 
+#define 	AT91C_EMAC_RBOF_OFFSET_0             (0x0 << 14) // (EMAC) no offset from start of receive buffer
+#define 	AT91C_EMAC_RBOF_OFFSET_1             (0x1 << 14) // (EMAC) one byte offset from start of receive buffer
+#define 	AT91C_EMAC_RBOF_OFFSET_2             (0x2 << 14) // (EMAC) two bytes offset from start of receive buffer
+#define 	AT91C_EMAC_RBOF_OFFSET_3             (0x3 << 14) // (EMAC) three bytes offset from start of receive buffer
+#define AT91C_EMAC_RLCE       (0x1 << 16) // (EMAC) Receive Length field Checking Enable
+#define AT91C_EMAC_DRFCS      (0x1 << 17) // (EMAC) Discard Receive FCS
+#define AT91C_EMAC_EFRHD      (0x1 << 18) // (EMAC) 
+#define AT91C_EMAC_IRXFCS     (0x1 << 19) // (EMAC) Ignore RX FCS
+// -------- EMAC_NSR : (EMAC Offset: 0x8) Network Status Register -------- 
+#define AT91C_EMAC_LINKR      (0x1 <<  0) // (EMAC) 
+#define AT91C_EMAC_MDIO       (0x1 <<  1) // (EMAC) 
+#define AT91C_EMAC_IDLE       (0x1 <<  2) // (EMAC) 
+// -------- EMAC_TSR : (EMAC Offset: 0x14) Transmit Status Register -------- 
+#define AT91C_EMAC_UBR        (0x1 <<  0) // (EMAC) 
+#define AT91C_EMAC_COL        (0x1 <<  1) // (EMAC) 
+#define AT91C_EMAC_RLES       (0x1 <<  2) // (EMAC) 
+#define AT91C_EMAC_TGO        (0x1 <<  3) // (EMAC) Transmit Go
+#define AT91C_EMAC_BEX        (0x1 <<  4) // (EMAC) Buffers exhausted mid frame
+#define AT91C_EMAC_COMP       (0x1 <<  5) // (EMAC) 
+#define AT91C_EMAC_UND        (0x1 <<  6) // (EMAC) 
+// -------- EMAC_RSR : (EMAC Offset: 0x20) Receive Status Register -------- 
+#define AT91C_EMAC_BNA        (0x1 <<  0) // (EMAC) 
+#define AT91C_EMAC_REC        (0x1 <<  1) // (EMAC) 
+#define AT91C_EMAC_OVR        (0x1 <<  2) // (EMAC) 
+// -------- EMAC_ISR : (EMAC Offset: 0x24) Interrupt Status Register -------- 
+#define AT91C_EMAC_MFD        (0x1 <<  0) // (EMAC) 
+#define AT91C_EMAC_RCOMP      (0x1 <<  1) // (EMAC) 
+#define AT91C_EMAC_RXUBR      (0x1 <<  2) // (EMAC) 
+#define AT91C_EMAC_TXUBR      (0x1 <<  3) // (EMAC) 
+#define AT91C_EMAC_TUNDR      (0x1 <<  4) // (EMAC) 
+#define AT91C_EMAC_RLEX       (0x1 <<  5) // (EMAC) 
+#define AT91C_EMAC_TXERR      (0x1 <<  6) // (EMAC) 
+#define AT91C_EMAC_TCOMP      (0x1 <<  7) // (EMAC) 
+#define AT91C_EMAC_LINK       (0x1 <<  9) // (EMAC) 
+#define AT91C_EMAC_ROVR       (0x1 << 10) // (EMAC) 
+#define AT91C_EMAC_HRESP      (0x1 << 11) // (EMAC) 
+#define AT91C_EMAC_PFRE       (0x1 << 12) // (EMAC) 
+#define AT91C_EMAC_PTZ        (0x1 << 13) // (EMAC) 
+#define AT91C_EMAC_WOLEV      (0x1 << 14) // (EMAC) 
+// -------- EMAC_IER : (EMAC Offset: 0x28) Interrupt Enable Register -------- 
+#define AT91C_                (0x0 << 14) // (EMAC) 
+// -------- EMAC_IDR : (EMAC Offset: 0x2c) Interrupt Disable Register -------- 
+// -------- EMAC_IMR : (EMAC Offset: 0x30) Interrupt Mask Register -------- 
+// -------- EMAC_MAN : (EMAC Offset: 0x34) PHY Maintenance Register -------- 
+#define AT91C_EMAC_DATA       (0xFFFF <<  0) // (EMAC) 
+#define AT91C_EMAC_CODE       (0x3 << 16) // (EMAC) 
+#define AT91C_EMAC_REGA       (0x1F << 18) // (EMAC) 
+#define AT91C_EMAC_PHYA       (0x1F << 23) // (EMAC) 
+#define AT91C_EMAC_RW         (0x3 << 28) // (EMAC) 
+#define AT91C_EMAC_SOF        (0x3 << 30) // (EMAC) 
+// -------- EMAC_USRIO : (EMAC Offset: 0xc0) USER Input Output Register -------- 
+#define AT91C_EMAC_RMII       (0x1 <<  0) // (EMAC) Reduce MII
+#define AT91C_EMAC_CLKEN      (0x1 <<  1) // (EMAC) Clock Enable
+// -------- EMAC_WOL : (EMAC Offset: 0xc4) Wake On LAN Register -------- 
+#define AT91C_EMAC_IP         (0xFFFF <<  0) // (EMAC) ARP request IP address
+#define AT91C_EMAC_MAG        (0x1 << 16) // (EMAC) Magic packet event enable
+#define AT91C_EMAC_ARP        (0x1 << 17) // (EMAC) ARP request event enable
+#define AT91C_EMAC_SA1        (0x1 << 18) // (EMAC) Specific address register 1 event enable
+// -------- EMAC_REV : (EMAC Offset: 0xfc) Revision Register -------- 
+#define AT91C_EMAC_REVREF     (0xFFFF <<  0) // (EMAC) 
+#define AT91C_EMAC_PARTREF    (0xFFFF << 16) // (EMAC) 
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR Image Sensor Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_ISI {
+	AT91_REG	 ISI_CFG1; 	// Configuration Register 1
+	AT91_REG	 ISI_CFG2; 	// Configuration Register 2
+	AT91_REG	 ISI_PSIZE; 	// Preview Size Register
+	AT91_REG	 ISI_PDECF; 	// Preview Decimation Factor Register
+	AT91_REG	 ISI_Y2RSET0; 	// Color Space Conversion YCrCb to RGB Register
+	AT91_REG	 ISI_Y2RSET1; 	// Color Space Conversion YCrCb to RGB Register
+	AT91_REG	 ISI_R2YSET0; 	// Color Space Conversion RGB to YCrCb Register
+	AT91_REG	 ISI_R2YSET1; 	// Color Space Conversion RGB to YCrCb Register
+	AT91_REG	 ISI_R2YSET2; 	// Color Space Conversion RGB to YCrCb Register
+	AT91_REG	 ISI_CTRL; 	// Control Register
+	AT91_REG	 ISI_SR; 	// Status Register
+	AT91_REG	 ISI_IER; 	// Interrupt Enable Register
+	AT91_REG	 ISI_IDR; 	// Interrupt Disable Register
+	AT91_REG	 ISI_IMR; 	// Interrupt Mask Register
+	AT91_REG	 ISI_DMACHER; 	// DMA Channel Enable Register
+	AT91_REG	 ISI_DMACHDR; 	// DMA Channel Disable Register
+	AT91_REG	 ISI_DMACHSR; 	// DMA Channel Status Register
+	AT91_REG	 ISI_DMAPADDR; 	// DMA Preview Base Address Register
+	AT91_REG	 ISI_DMAPCTRL; 	// DMA Preview Control Register
+	AT91_REG	 ISI_DMAPDSCR; 	// DMA Preview Descriptor Address Register
+	AT91_REG	 ISI_DMACADDR; 	// DMA Codec Base Address Register
+	AT91_REG	 ISI_DMACCTRL; 	// DMA Codec Control Register
+	AT91_REG	 ISI_DMACDSCR; 	// DMA Codec Descriptor Address Register
+	AT91_REG	 Reserved0[34]; 	// 
+	AT91_REG	 ISI_WPCR; 	// Write Protection Control Register
+	AT91_REG	 ISI_WPSR; 	// Write Protection Status Register
+	AT91_REG	 Reserved1[4]; 	// 
+	AT91_REG	 ISI_VER; 	// Version Register
+} AT91S_ISI, *AT91PS_ISI;
+#else
+#define ISI_CFG1        (AT91_CAST(AT91_REG *) 	0x00000000) // (ISI_CFG1) Configuration Register 1
+#define ISI_CFG2        (AT91_CAST(AT91_REG *) 	0x00000004) // (ISI_CFG2) Configuration Register 2
+#define ISI_PSIZE       (AT91_CAST(AT91_REG *) 	0x00000008) // (ISI_PSIZE) Preview Size Register
+#define ISI_PDECF       (AT91_CAST(AT91_REG *) 	0x0000000C) // (ISI_PDECF) Preview Decimation Factor Register
+#define ISI_Y2RSET0     (AT91_CAST(AT91_REG *) 	0x00000010) // (ISI_Y2RSET0) Color Space Conversion YCrCb to RGB Register
+#define ISI_Y2RSET1     (AT91_CAST(AT91_REG *) 	0x00000014) // (ISI_Y2RSET1) Color Space Conversion YCrCb to RGB Register
+#define ISI_R2YSET0     (AT91_CAST(AT91_REG *) 	0x00000018) // (ISI_R2YSET0) Color Space Conversion RGB to YCrCb Register
+#define ISI_R2YSET1     (AT91_CAST(AT91_REG *) 	0x0000001C) // (ISI_R2YSET1) Color Space Conversion RGB to YCrCb Register
+#define ISI_R2YSET2     (AT91_CAST(AT91_REG *) 	0x00000020) // (ISI_R2YSET2) Color Space Conversion RGB to YCrCb Register
+#define ISI_CTRL        (AT91_CAST(AT91_REG *) 	0x00000024) // (ISI_CTRL) Control Register
+#define ISI_SR          (AT91_CAST(AT91_REG *) 	0x00000028) // (ISI_SR) Status Register
+#define ISI_IER         (AT91_CAST(AT91_REG *) 	0x0000002C) // (ISI_IER) Interrupt Enable Register
+#define ISI_IDR         (AT91_CAST(AT91_REG *) 	0x00000030) // (ISI_IDR) Interrupt Disable Register
+#define ISI_IMR         (AT91_CAST(AT91_REG *) 	0x00000034) // (ISI_IMR) Interrupt Mask Register
+#define ISI_DMACHER     (AT91_CAST(AT91_REG *) 	0x00000038) // (ISI_DMACHER) DMA Channel Enable Register
+#define ISI_DMACHDR     (AT91_CAST(AT91_REG *) 	0x0000003C) // (ISI_DMACHDR) DMA Channel Disable Register
+#define ISI_DMACHSR     (AT91_CAST(AT91_REG *) 	0x00000040) // (ISI_DMACHSR) DMA Channel Status Register
+#define ISI_DMAPADDR    (AT91_CAST(AT91_REG *) 	0x00000044) // (ISI_DMAPADDR) DMA Preview Base Address Register
+#define ISI_DMAPCTRL    (AT91_CAST(AT91_REG *) 	0x00000048) // (ISI_DMAPCTRL) DMA Preview Control Register
+#define ISI_DMAPDSCR    (AT91_CAST(AT91_REG *) 	0x0000004C) // (ISI_DMAPDSCR) DMA Preview Descriptor Address Register
+#define ISI_DMACADDR    (AT91_CAST(AT91_REG *) 	0x00000050) // (ISI_DMACADDR) DMA Codec Base Address Register
+#define ISI_DMACCTRL    (AT91_CAST(AT91_REG *) 	0x00000054) // (ISI_DMACCTRL) DMA Codec Control Register
+#define ISI_DMACDSCR    (AT91_CAST(AT91_REG *) 	0x00000058) // (ISI_DMACDSCR) DMA Codec Descriptor Address Register
+#define ISI_WPCR        (AT91_CAST(AT91_REG *) 	0x000000E4) // (ISI_WPCR) Write Protection Control Register
+#define ISI_WPSR        (AT91_CAST(AT91_REG *) 	0x000000E8) // (ISI_WPSR) Write Protection Status Register
+#define ISI_VER         (AT91_CAST(AT91_REG *) 	0x000000FC) // (ISI_VER) Version Register
+
+#endif
+// -------- ISI_CFG1 : (ISI Offset: 0x0) ISI Configuration Register 1 -------- 
+#define AT91C_ISI_HSYNC_POL   (0x1 <<  2) // (ISI) Horizontal synchronization polarity
+#define 	AT91C_ISI_HSYNC_POL_ACTIVE_HIGH          (0x0 <<  2) // (ISI) HSYNC active high.
+#define 	AT91C_ISI_HSYNC_POL_ACTIVE_LOW           (0x1 <<  2) // (ISI) HSYNC active low.
+#define AT91C_ISI_VSYNC_POL   (0x1 <<  3) // (ISI) Vertical synchronization polarity
+#define 	AT91C_ISI_VSYNC_POL_ACTIVE_HIGH          (0x0 <<  3) // (ISI) VSYNC active high.
+#define 	AT91C_ISI_VSYNC_POL_ACTIVE_LOW           (0x1 <<  3) // (ISI) VSYNC active low.
+#define AT91C_ISI_PIXCLK_POL  (0x1 <<  4) // (ISI) Pixel Clock Polarity
+#define 	AT91C_ISI_PIXCLK_POL_RISING_EDGE          (0x0 <<  4) // (ISI) Data is sampled on rising edge of pixel clock.
+#define 	AT91C_ISI_PIXCLK_POL_FALLING_EDGE         (0x1 <<  4) // (ISI) Data is sampled on falling edge of pixel clock.
+#define AT91C_ISI_EMB_SYNC    (0x1 <<  6) // (ISI) Embedded synchronisation
+#define 	AT91C_ISI_EMB_SYNC_HSYNC_VSYNC          (0x0 <<  6) // (ISI) Synchronization by HSYNC, VSYNC.
+#define 	AT91C_ISI_EMB_SYNC_SAV_EAV              (0x1 <<  6) // (ISI) Synchronisation by Embedded Synchronization Sequence SAV/EAV.
+#define AT91C_ISI_CRC_SYNC    (0x1 <<  7) // (ISI) CRC correction
+#define 	AT91C_ISI_CRC_SYNC_CORRECTION_OFF       (0x0 <<  7) // (ISI) No CRC correction performed on embedded synchronization.
+#define 	AT91C_ISI_CRC_SYNC_CORRECTION_ON        (0x1 <<  7) // (ISI) CRC correction is performed.
+#define AT91C_ISI_FRATE       (0x7 <<  8) // (ISI) Frame rate capture
+#define AT91C_ISI_FULL        (0x1 << 12) // (ISI) Full mode is allowed
+#define 	AT91C_ISI_FULL_MODE_DISABLE         (0x0 << 12) // (ISI) Full mode disabled.
+#define 	AT91C_ISI_FULL_MODE_ENABLE          (0x1 << 12) // (ISI) both codec and preview datapath are working simultaneously.
+#define AT91C_ISI_THMASK      (0x3 << 13) // (ISI) DMA Burst Mask
+#define 	AT91C_ISI_THMASK_4_BURST              (0x0 << 13) // (ISI) Only 4 beats AHB bursts are allowed
+#define 	AT91C_ISI_THMASK_4_8_BURST            (0x1 << 13) // (ISI) Only 4 and 8 beats AHB bursts are allowed
+#define 	AT91C_ISI_THMASK_4_8_16_BURST         (0x2 << 13) // (ISI) 4, 8 and 16 beats AHB bursts are allowed
+#define AT91C_ISI_SLD         (0xFF << 16) // (ISI) Start of Line Delay
+#define AT91C_ISI_SFD         (0xFF << 24) // (ISI) Start of frame Delay
+// -------- ISI_CFG2 : (ISI Offset: 0x4) ISI Control Register 2 -------- 
+#define AT91C_ISI_IM_VSIZE    (0x7FF <<  0) // (ISI) Vertical size of the Image sensor [0..2047]
+#define AT91C_ISI_GS_MODE     (0x1 << 11) // (ISI) Grayscale Memory Mode
+#define 	AT91C_ISI_GS_MODE_2_PIXELS             (0x0 << 11) // (ISI) 2 pixels per word.
+#define 	AT91C_ISI_GS_MODE_1_PIXEL              (0x1 << 11) // (ISI) 1 pixel per word.
+#define AT91C_ISI_RGB_MODE    (0x1 << 12) // (ISI) RGB mode
+#define 	AT91C_ISI_RGB_MODE_RGB_888              (0x0 << 12) // (ISI) RGB 8:8:8 24 bits
+#define 	AT91C_ISI_RGB_MODE_RGB_565              (0x1 << 12) // (ISI) RGB 5:6:5 16 bits
+#define AT91C_ISI_GRAYSCALE   (0x1 << 13) // (ISI) Grayscale Mode
+#define 	AT91C_ISI_GRAYSCALE_DISABLE              (0x0 << 13) // (ISI) Grayscale mode is disabled
+#define 	AT91C_ISI_GRAYSCALE_ENABLE               (0x1 << 13) // (ISI) Input image is assumed to be grayscale coded
+#define AT91C_ISI_RGB_SWAP    (0x1 << 14) // (ISI) RGB Swap
+#define 	AT91C_ISI_RGB_SWAP_DISABLE              (0x0 << 14) // (ISI) D7 -> R7
+#define 	AT91C_ISI_RGB_SWAP_ENABLE               (0x1 << 14) // (ISI) D0 -> R7
+#define AT91C_ISI_COL_SPACE   (0x1 << 15) // (ISI) Color space for the image data
+#define 	AT91C_ISI_COL_SPACE_YCBCR                (0x0 << 15) // (ISI) YCbCr
+#define 	AT91C_ISI_COL_SPACE_RGB                  (0x1 << 15) // (ISI) RGB
+#define AT91C_ISI_IM_HSIZE    (0x7FF << 16) // (ISI) Horizontal size of the Image sensor [0..2047]
+#define AT91C_ISI_YCC_SWAP    (0x3 << 28) // (ISI) Ycc swap
+#define 	AT91C_ISI_YCC_SWAP_YCC_DEFAULT          (0x0 << 28) // (ISI) Cb(i) Y(i) Cr(i) Y(i+1)
+#define 	AT91C_ISI_YCC_SWAP_YCC_MODE1            (0x1 << 28) // (ISI) Cr(i) Y(i) Cb(i) Y(i+1)
+#define 	AT91C_ISI_YCC_SWAP_YCC_MODE2            (0x2 << 28) // (ISI) Y(i) Cb(i) Y(i+1) Cr(i)
+#define 	AT91C_ISI_YCC_SWAP_YCC_MODE3            (0x3 << 28) // (ISI) Y(i) Cr(i) Y(i+1) Cb(i)
+#define AT91C_ISI_RGB_CFG     (0x3 << 30) // (ISI) RGB configuration
+#define 	AT91C_ISI_RGB_CFG_RGB_DEFAULT          (0x0 << 30) // (ISI) R/G(MSB)  G(LSB)/B  R/G(MSB)  G(LSB)/B
+#define 	AT91C_ISI_RGB_CFG_RGB_MODE1            (0x1 << 30) // (ISI) B/G(MSB)  G(LSB)/R  B/G(MSB)  G(LSB)/R
+#define 	AT91C_ISI_RGB_CFG_RGB_MODE2            (0x2 << 30) // (ISI) G(LSB)/R  B/G(MSB)  G(LSB)/R  B/G(MSB)
+#define 	AT91C_ISI_RGB_CFG_RGB_MODE3            (0x3 << 30) // (ISI) G(LSB)/B  R/G(MSB)  G(LSB)/B  R/G(MSB)
+// -------- ISI_PSIZE : (ISI Offset: 0x8) ISI Preview Register -------- 
+#define AT91C_ISI_PREV_VSIZE  (0x3FF <<  0) // (ISI) Vertical size for the preview path
+#define AT91C_ISI_PREV_HSIZE  (0x3FF << 16) // (ISI) Horizontal size for the preview path
+// -------- ISI_PDECF : (ISI Offset: 0xc) ISI Preview Decimation Factor Register -------- 
+#define AT91C_ISI_DEC_FACTOR  (0xFF <<  0) // (ISI) Decimation factor
+// -------- ISI_Y2RSET0 : (ISI Offset: 0x10) Color Space Conversion YCrCb to RGB Register -------- 
+#define AT91C_ISI_Y2R_C0      (0xFF <<  0) // (ISI) Color Space Conversion Matrix Coefficient C0
+#define AT91C_ISI_Y2R_C1      (0xFF <<  8) // (ISI) Color Space Conversion Matrix Coefficient C1
+#define AT91C_ISI_Y2R_C2      (0xFF << 16) // (ISI) Color Space Conversion Matrix Coefficient C2
+#define AT91C_ISI_Y2R_C3      (0xFF << 24) // (ISI) Color Space Conversion Matrix Coefficient C3
+// -------- ISI_Y2RSET1 : (ISI Offset: 0x14) ISI Color Space Conversion YCrCb to RGB set 1 Register -------- 
+#define AT91C_ISI_Y2R_C4      (0x1FF <<  0) // (ISI) Color Space Conversion Matrix Coefficient C4
+#define AT91C_ISI_Y2R_YOFF    (0x1 << 12) // (ISI) Color Space Conversion Luninance default offset
+#define 	AT91C_ISI_Y2R_YOFF_0                    (0x0 << 12) // (ISI) Offset is 0
+#define 	AT91C_ISI_Y2R_YOFF_128                  (0x1 << 12) // (ISI) Offset is 128
+#define AT91C_ISI_Y2R_CROFF   (0x1 << 13) // (ISI) Color Space Conversion Red Chrominance default offset
+#define 	AT91C_ISI_Y2R_CROFF_0                    (0x0 << 13) // (ISI) Offset is 0
+#define 	AT91C_ISI_Y2R_CROFF_16                   (0x1 << 13) // (ISI) Offset is 16
+#define AT91C_ISI_Y2R_CBOFF   (0x1 << 14) // (ISI) Color Space Conversion Blue Chrominance default offset
+#define 	AT91C_ISI_Y2R_CBOFF_0                    (0x0 << 14) // (ISI) Offset is 0
+#define 	AT91C_ISI_Y2R_CBOFF_16                   (0x1 << 14) // (ISI) Offset is 16
+// -------- ISI_R2YSET0 : (ISI Offset: 0x18) Color Space Conversion RGB to YCrCb set 0 register -------- 
+#define AT91C_ISI_R2Y_C0      (0x7F <<  0) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C0
+#define AT91C_ISI_R2Y_C1      (0x7F <<  8) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C1
+#define AT91C_ISI_R2Y_C2      (0x7F << 16) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C2
+#define AT91C_ISI_R2Y_ROFF    (0x1 << 24) // (ISI) Color Space Conversion Red component offset
+#define 	AT91C_ISI_R2Y_ROFF_0                    (0x0 << 24) // (ISI) Offset is 0
+#define 	AT91C_ISI_R2Y_ROFF_16                   (0x1 << 24) // (ISI) Offset is 16
+// -------- ISI_R2YSET1 : (ISI Offset: 0x1c) Color Space Conversion RGB to YCrCb set 1 register -------- 
+#define AT91C_ISI_R2Y_C3      (0x7F <<  0) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C3
+#define AT91C_ISI_R2Y_C4      (0x7F <<  8) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C4
+#define AT91C_ISI_R2Y_C5      (0x7F << 16) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C5
+#define AT91C_ISI_R2Y_GOFF    (0x1 << 24) // (ISI) Color Space Conversion Green component offset
+#define 	AT91C_ISI_R2Y_GOFF_0                    (0x0 << 24) // (ISI) Offset is 0
+#define 	AT91C_ISI_R2Y_GOFF_128                  (0x1 << 24) // (ISI) Offset is 128
+// -------- ISI_R2YSET2 : (ISI Offset: 0x20) Color Space Conversion RGB to YCrCb set 2 register -------- 
+#define AT91C_ISI_R2Y_C6      (0x7F <<  0) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C6
+#define AT91C_ISI_R2Y_C7      (0x7F <<  8) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C7
+#define AT91C_ISI_R2Y_C8      (0x7F << 16) // (ISI) Color Space Conversion RGB to YCrCb Matrix coefficient C8
+#define AT91C_ISI_R2Y_BOFF    (0x1 << 24) // (ISI) Color Space Conversion Blue component offset
+#define 	AT91C_ISI_R2Y_BOFF_0                    (0x0 << 24) // (ISI) Offset is 0
+#define 	AT91C_ISI_R2Y_BOFF_128                  (0x1 << 24) // (ISI) Offset is 128
+// -------- ISI_CTRL : (ISI Offset: 0x24) ISI Control Register -------- 
+#define AT91C_ISI_EN          (0x1 <<  0) // (ISI) Image Sensor Interface Enable Request
+#define 	AT91C_ISI_EN_0                    (0x0) // (ISI) No effect
+#define 	AT91C_ISI_EN_1                    (0x1) // (ISI) Enable the module and the capture
+#define AT91C_ISI_DIS         (0x1 <<  1) // (ISI) Image Sensor Interface Disable Request
+#define 	AT91C_ISI_DIS_0                    (0x0 <<  1) // (ISI) No effect
+#define 	AT91C_ISI_DIS_1                    (0x1 <<  1) // (ISI) Disable the module and the capture
+#define AT91C_ISI_SRST        (0x1 <<  2) // (ISI) Software Reset Request
+#define 	AT91C_ISI_SRST_0                    (0x0 <<  2) // (ISI) No effect
+#define 	AT91C_ISI_SRST_1                    (0x1 <<  2) // (ISI) Reset the module
+#define AT91C_ISI_CDC         (0x1 <<  8) // (ISI) Codec Request
+#define 	AT91C_ISI_CDC_0                    (0x0 <<  8) // (ISI) No effect
+#define 	AT91C_ISI_CDC_1                    (0x1 <<  8) // (ISI) Enable the Codec
+// -------- ISI_SR : (ISI Offset: 0x28) ISI Status Register -------- 
+#define AT91C_ISI_VSYNC       (0x1 << 10) // (ISI) Vertical Synchronization
+#define 	AT91C_ISI_VSYNC_0                    (0x0 << 10) // (ISI) No effect
+#define 	AT91C_ISI_VSYNC_1                    (0x1 << 10) // (ISI) Indicates that a Vertical Synchronization has been detected since last read
+#define AT91C_ISI_PXFR_DONE   (0x1 << 16) // (ISI) Preview DMA transfer terminated
+#define 	AT91C_ISI_PXFR_DONE_0                    (0x0 << 16) // (ISI) No effect
+#define 	AT91C_ISI_PXFR_DONE_1                    (0x1 << 16) // (ISI) Indicates that DATA transfer on preview channel has completed since last read
+#define AT91C_ISI_CXFR_DONE   (0x1 << 17) // (ISI) Codec DMA transfer terminated
+#define 	AT91C_ISI_CXFR_DONE_0                    (0x0 << 17) // (ISI) No effect
+#define 	AT91C_ISI_CXFR_DONE_1                    (0x1 << 17) // (ISI) Indicates that DATA transfer on preview channel has completed since last read
+#define AT91C_ISI_SIP         (0x1 << 19) // (ISI) Synchronization In Progress
+#define 	AT91C_ISI_SIP_0                    (0x0 << 19) // (ISI) No effect
+#define 	AT91C_ISI_SIP_1                    (0x1 << 19) // (ISI) Indicates that Synchronization is in progress
+#define AT91C_ISI_P_OVR       (0x1 << 24) // (ISI) Fifo Preview Overflow 
+#define 	AT91C_ISI_P_OVR_0                    (0x0 << 24) // (ISI) No error
+#define 	AT91C_ISI_P_OVR_1                    (0x1 << 24) // (ISI) An overrun condition has occurred in input FIFO on the preview path
+#define AT91C_ISI_C_OVR       (0x1 << 25) // (ISI) Fifo Codec Overflow 
+#define 	AT91C_ISI_C_OVR_0                    (0x0 << 25) // (ISI) No error
+#define 	AT91C_ISI_C_OVR_1                    (0x1 << 25) // (ISI) An overrun condition has occurred in input FIFO on the codec path
+#define AT91C_ISI_CRC_ERR     (0x1 << 26) // (ISI) CRC synchronisation error
+#define 	AT91C_ISI_CRC_ERR_0                    (0x0 << 26) // (ISI) No error
+#define 	AT91C_ISI_CRC_ERR_1                    (0x1 << 26) // (ISI) CRC_SYNC is enabled in the control register and an error has been detected and not corrected. The frame is discarded and the ISI waits for a new one.
+#define AT91C_ISI_FR_OVR      (0x1 << 27) // (ISI) Frame rate overun
+#define 	AT91C_ISI_FR_OVR_0                    (0x0 << 27) // (ISI) No error
+#define 	AT91C_ISI_FR_OVR_1                    (0x1 << 27) // (ISI) Frame overrun, the current frame is being skipped because a vsync signal has been detected while flushing FIFOs.
+// -------- ISI_IER : (ISI Offset: 0x2c) ISI Interrupt Enable Register -------- 
+// -------- ISI_IDR : (ISI Offset: 0x30) ISI Interrupt Disable Register -------- 
+// -------- ISI_IMR : (ISI Offset: 0x34) ISI Interrupt Mask Register -------- 
+// -------- ISI_DMACHER : (ISI Offset: 0x38) DMA Channel Enable Register -------- 
+#define AT91C_ISI_P_CH_EN     (0x1 <<  0) // (ISI) Preview Channel Enable
+#define 	AT91C_ISI_P_CH_EN_0                    (0x0) // (ISI) No effect
+#define 	AT91C_ISI_P_CH_EN_1                    (0x1) // (ISI) Enable the Preview Channel
+#define AT91C_ISI_C_CH_EN     (0x1 <<  1) // (ISI) Codec Channel Enable
+#define 	AT91C_ISI_C_CH_EN_0                    (0x0 <<  1) // (ISI) No effect
+#define 	AT91C_ISI_C_CH_EN_1                    (0x1 <<  1) // (ISI) Enable the Codec Channel
+// -------- ISI_DMACHDR : (ISI Offset: 0x3c) DMA Channel Enable Register -------- 
+#define AT91C_ISI_P_CH_DIS    (0x1 <<  0) // (ISI) Preview Channel Disable
+#define 	AT91C_ISI_P_CH_DIS_0                    (0x0) // (ISI) No effect
+#define 	AT91C_ISI_P_CH_DIS_1                    (0x1) // (ISI) Disable the Preview Channel
+#define AT91C_ISI_C_CH_DIS    (0x1 <<  1) // (ISI) Codec Channel Disable
+#define 	AT91C_ISI_C_CH_DIS_0                    (0x0 <<  1) // (ISI) No effect
+#define 	AT91C_ISI_C_CH_DIS_1                    (0x1 <<  1) // (ISI) Disable the Codec Channel
+// -------- ISI_DMACHSR : (ISI Offset: 0x40) DMA Channel Status Register -------- 
+#define AT91C_ISI_P_CH_S      (0x1 <<  0) // (ISI) Preview Channel Disable
+#define 	AT91C_ISI_P_CH_S_0                    (0x0) // (ISI) Preview Channel is disabled
+#define 	AT91C_ISI_P_CH_S_1                    (0x1) // (ISI) Preview Channel is enabled
+#define AT91C_ISI_C_CH_S      (0x1 <<  1) // (ISI) Codec Channel Disable
+#define 	AT91C_ISI_C_CH_S_0                    (0x0 <<  1) // (ISI) Codec Channel is disabled
+#define 	AT91C_ISI_C_CH_S_1                    (0x1 <<  1) // (ISI) Codec Channel is enabled
+// -------- ISI_DMAPCTRL : (ISI Offset: 0x48) DMA Preview Control Register -------- 
+#define AT91C_ISI_P_FETCH     (0x1 <<  0) // (ISI) Preview Descriptor Fetch Control Field
+#define 	AT91C_ISI_P_FETCH_DISABLE              (0x0) // (ISI) Preview Channel Fetch Operation is disabled
+#define 	AT91C_ISI_P_FETCH_ENABLE               (0x1) // (ISI) Preview Channel Fetch Operation is enabled
+#define AT91C_ISI_P_DONE      (0x1 <<  1) // (ISI) Preview Transfer Done Flag
+#define 	AT91C_ISI_P_DONE_0                    (0x0 <<  1) // (ISI) Preview Transfer has not been performed
+#define 	AT91C_ISI_P_DONE_1                    (0x1 <<  1) // (ISI) Preview Transfer has completed
+// -------- ISI_DMACCTRL : (ISI Offset: 0x54) DMA Codec Control Register -------- 
+#define AT91C_ISI_C_FETCH     (0x1 <<  0) // (ISI) Codec Descriptor Fetch Control Field
+#define 	AT91C_ISI_C_FETCH_DISABLE              (0x0) // (ISI) Codec Channel Fetch Operation is disabled
+#define 	AT91C_ISI_C_FETCH_ENABLE               (0x1) // (ISI) Codec Channel Fetch Operation is enabled
+#define AT91C_ISI_C_DONE      (0x1 <<  1) // (ISI) Codec Transfer Done Flag
+#define 	AT91C_ISI_C_DONE_0                    (0x0 <<  1) // (ISI) Codec Transfer has not been performed
+#define 	AT91C_ISI_C_DONE_1                    (0x1 <<  1) // (ISI) Codec Transfer has completed
+// -------- ISI_WPCR : (ISI Offset: 0xe4) Write Protection Control Register -------- 
+#define AT91C_ISI_WP_EN       (0x1 <<  0) // (ISI) Write Protection Enable
+#define 	AT91C_ISI_WP_EN_DISABLE              (0x0) // (ISI) Write Operation is disabled (if WP_KEY corresponds)
+#define 	AT91C_ISI_WP_EN_ENABLE               (0x1) // (ISI) Write Operation is enabled (if WP_KEY corresponds)
+#define AT91C_ISI_WP_KEY      (0xFFFFFF <<  8) // (ISI) Write Protection Key
+// -------- ISI_WPSR : (ISI Offset: 0xe8) Write Protection Status Register -------- 
+#define AT91C_ISI_WP_VS       (0xF <<  0) // (ISI) Write Protection Violation Status
+#define 	AT91C_ISI_WP_VS_NO_VIOLATION         (0x0) // (ISI) No Write Protection Violation detected since last read
+#define 	AT91C_ISI_WP_VS_ON_WRITE             (0x1) // (ISI) Write Protection Violation detected since last read
+#define 	AT91C_ISI_WP_VS_ON_RESET             (0x2) // (ISI) Software Reset Violation detected since last read
+#define 	AT91C_ISI_WP_VS_ON_BOTH              (0x3) // (ISI) Write Protection and Software Reset Violation detected since last read
+#define AT91C_ISI_WP_VSRC     (0xF <<  8) // (ISI) Write Protection Violation Source
+#define 	AT91C_ISI_WP_VSRC_NO_VIOLATION         (0x0 <<  8) // (ISI) No Write Protection Violation detected since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_CFG1             (0x1 <<  8) // (ISI) Write Protection Violation detected on ISI_CFG1 since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_CFG2             (0x2 <<  8) // (ISI) Write Protection Violation detected on ISI_CFG2 since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_PSIZE            (0x3 <<  8) // (ISI) Write Protection Violation detected on ISI_PSIZE since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_PDECF            (0x4 <<  8) // (ISI) Write Protection Violation detected on ISI_PDECF since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_Y2RSET0          (0x5 <<  8) // (ISI) Write Protection Violation detected on ISI_Y2RSET0 since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_Y2RSET1          (0x6 <<  8) // (ISI) Write Protection Violation detected on ISI_Y2RSET1 since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_R2YSET0          (0x7 <<  8) // (ISI) Write Protection Violation detected on ISI_R2YSET0 since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_R2YSET1          (0x8 <<  8) // (ISI) Write Protection Violation detected on ISI_R2YSET1 since last read
+#define 	AT91C_ISI_WP_VSRC_ISI_R2YSET2          (0x9 <<  8) // (ISI) Write Protection Violation detected on ISI_R2YSET2 since last read
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR USB Host Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_UHPHS_OHCI {
+	AT91_REG	 UHPHS_OHCI_HcRevision; 	// Revision
+	AT91_REG	 UHPHS_OHCI_HcControl; 	// Operating modes for the Host Controller
+	AT91_REG	 UHPHS_OHCI_HcCommandStatus; 	// Command & status Register
+	AT91_REG	 UHPHS_OHCI_HcInterruptStatus; 	// Interrupt Status Register
+	AT91_REG	 UHPHS_OHCI_HcInterruptEnable; 	// Interrupt Enable Register
+	AT91_REG	 UHPHS_OHCI_HcInterruptDisable; 	// Interrupt Disable Register
+	AT91_REG	 UHPHS_OHCI_HcHCCA; 	// Pointer to the Host Controller Communication Area
+	AT91_REG	 UHPHS_OHCI_HcPeriodCurrentED; 	// Current Isochronous or Interrupt Endpoint Descriptor
+	AT91_REG	 UHPHS_OHCI_HcControlHeadED; 	// First Endpoint Descriptor of the Control list
+	AT91_REG	 UHPHS_OHCI_HcControlCurrentED; 	// Endpoint Control and Status Register
+	AT91_REG	 UHPHS_OHCI_HcBulkHeadED; 	// First endpoint register of the Bulk list
+	AT91_REG	 UHPHS_OHCI_HcBulkCurrentED; 	// Current endpoint of the Bulk list
+	AT91_REG	 UHPHS_OHCI_HcBulkDoneHead; 	// Last completed transfer descriptor
+	AT91_REG	 UHPHS_OHCI_HcFmInterval; 	// Bit time between 2 consecutive SOFs
+	AT91_REG	 UHPHS_OHCI_HcFmRemaining; 	// Bit time remaining in the current Frame
+	AT91_REG	 UHPHS_OHCI_HcFmNumber; 	// Frame number
+	AT91_REG	 UHPHS_OHCI_HcPeriodicStart; 	// Periodic Start
+	AT91_REG	 UHPHS_OHCI_HcLSThreshold; 	// LS Threshold
+	AT91_REG	 UHPHS_OHCI_HcRhDescriptorA; 	// Root Hub characteristics A
+	AT91_REG	 UHPHS_OHCI_HcRhDescriptorB; 	// Root Hub characteristics B
+	AT91_REG	 UHPHS_OHCI_HcRhStatus; 	// Root Hub Status register
+	AT91_REG	 UHPHS_OHCI_HcRhPortStatus[2]; 	// Root Hub Port Status Register
+} AT91S_UHPHS_OHCI, *AT91PS_UHPHS_OHCI;
+#else
+#define HcRevision      (AT91_CAST(AT91_REG *) 	0x00000000) // (HcRevision) Revision
+#define HcControl       (AT91_CAST(AT91_REG *) 	0x00000004) // (HcControl) Operating modes for the Host Controller
+#define HcCommandStatus (AT91_CAST(AT91_REG *) 	0x00000008) // (HcCommandStatus) Command & status Register
+#define HcInterruptStatus (AT91_CAST(AT91_REG *) 	0x0000000C) // (HcInterruptStatus) Interrupt Status Register
+#define HcInterruptEnable (AT91_CAST(AT91_REG *) 	0x00000010) // (HcInterruptEnable) Interrupt Enable Register
+#define HcInterruptDisable (AT91_CAST(AT91_REG *) 	0x00000014) // (HcInterruptDisable) Interrupt Disable Register
+#define HcHCCA          (AT91_CAST(AT91_REG *) 	0x00000018) // (HcHCCA) Pointer to the Host Controller Communication Area
+#define HcPeriodCurrentED (AT91_CAST(AT91_REG *) 	0x0000001C) // (HcPeriodCurrentED) Current Isochronous or Interrupt Endpoint Descriptor
+#define HcControlHeadED (AT91_CAST(AT91_REG *) 	0x00000020) // (HcControlHeadED) First Endpoint Descriptor of the Control list
+#define HcControlCurrentED (AT91_CAST(AT91_REG *) 	0x00000024) // (HcControlCurrentED) Endpoint Control and Status Register
+#define HcBulkHeadED    (AT91_CAST(AT91_REG *) 	0x00000028) // (HcBulkHeadED) First endpoint register of the Bulk list
+#define HcBulkCurrentED (AT91_CAST(AT91_REG *) 	0x0000002C) // (HcBulkCurrentED) Current endpoint of the Bulk list
+#define HcBulkDoneHead  (AT91_CAST(AT91_REG *) 	0x00000030) // (HcBulkDoneHead) Last completed transfer descriptor
+#define HcFmInterval    (AT91_CAST(AT91_REG *) 	0x00000034) // (HcFmInterval) Bit time between 2 consecutive SOFs
+#define HcFmRemaining   (AT91_CAST(AT91_REG *) 	0x00000038) // (HcFmRemaining) Bit time remaining in the current Frame
+#define HcFmNumber      (AT91_CAST(AT91_REG *) 	0x0000003C) // (HcFmNumber) Frame number
+#define HcPeriodicStart (AT91_CAST(AT91_REG *) 	0x00000040) // (HcPeriodicStart) Periodic Start
+#define HcLSThreshold   (AT91_CAST(AT91_REG *) 	0x00000044) // (HcLSThreshold) LS Threshold
+#define HcRhDescriptorA (AT91_CAST(AT91_REG *) 	0x00000048) // (HcRhDescriptorA) Root Hub characteristics A
+#define HcRhDescriptorB (AT91_CAST(AT91_REG *) 	0x0000004C) // (HcRhDescriptorB) Root Hub characteristics B
+#define HcRhStatus      (AT91_CAST(AT91_REG *) 	0x00000050) // (HcRhStatus) Root Hub Status register
+#define HcRhPortStatus  (AT91_CAST(AT91_REG *) 	0x00000054) // (HcRhPortStatus) Root Hub Port Status Register
+
+#endif
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR USB Host Interface
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_UHPHS_EHCI {
+	AT91_REG	 UHPHS_EHCI_VERSION; 	// 
+	AT91_REG	 UHPHS_EHCI_HCSPARAMS; 	// 
+	AT91_REG	 UHPHS_EHCI_HCCPARAMS; 	// 
+	AT91_REG	 UHPHS_EHCI_HCSPPORTROUTE; 	// 
+	AT91_REG	 UHPHS_EHCI_USBCMD; 	// 
+	AT91_REG	 UHPHS_EHCI_USBSTS; 	// 
+	AT91_REG	 UHPHS_EHCI_USBINTR; 	// 
+	AT91_REG	 UHPHS_EHCI_FRINDEX; 	// 
+	AT91_REG	 UHPHS_EHCI_CTRLDSSEGMENT; 	// 
+	AT91_REG	 UHPHS_EHCI_PERIODICLISTBASE; 	// 
+	AT91_REG	 UHPHS_EHCI_ASYNCLISTADDR; 	// 
+	AT91_REG	 Reserved0[9]; 	// 
+	AT91_REG	 UHPHS_EHCI_CONFIGFLAG; 	// 
+	AT91_REG	 UHPHS_EHCI_PORTSC[2]; 	// 
+	AT91_REG	 Reserved1[13]; 	// 
+	AT91_REG	 UHPHS_EHCI_INSNREG00; 	// 
+	AT91_REG	 UHPHS_EHCI_INSNREG01; 	// 
+	AT91_REG	 UHPHS_EHCI_INSNREG02; 	// 
+	AT91_REG	 UHPHS_EHCI_INSNREG03; 	// 
+	AT91_REG	 UHPHS_EHCI_INSNREG04; 	// 
+	AT91_REG	 UHPHS_EHCI_INSNREG05; 	// 
+} AT91S_UHPHS_EHCI, *AT91PS_UHPHS_EHCI;
+#else
+#define VERSION         (AT91_CAST(AT91_REG *) 	0x00000000) // (VERSION) 
+#define HCSPARAMS       (AT91_CAST(AT91_REG *) 	0x00000004) // (HCSPARAMS) 
+#define HCCPARAMS       (AT91_CAST(AT91_REG *) 	0x00000008) // (HCCPARAMS) 
+#define HCSPPORTROUTE   (AT91_CAST(AT91_REG *) 	0x0000000C) // (HCSPPORTROUTE) 
+#define USBCMD          (AT91_CAST(AT91_REG *) 	0x00000010) // (USBCMD) 
+#define USBSTS          (AT91_CAST(AT91_REG *) 	0x00000014) // (USBSTS) 
+#define USBINTR         (AT91_CAST(AT91_REG *) 	0x00000018) // (USBINTR) 
+#define FRINDEX         (AT91_CAST(AT91_REG *) 	0x0000001C) // (FRINDEX) 
+#define CTRLDSSEGMENT   (AT91_CAST(AT91_REG *) 	0x00000020) // (CTRLDSSEGMENT) 
+#define PERIODICLISTBASE (AT91_CAST(AT91_REG *) 	0x00000024) // (PERIODICLISTBASE) 
+#define ASYNCLISTADDR   (AT91_CAST(AT91_REG *) 	0x00000028) // (ASYNCLISTADDR) 
+#define CONFIGFLAG      (AT91_CAST(AT91_REG *) 	0x00000050) // (CONFIGFLAG) 
+#define PORTSC          (AT91_CAST(AT91_REG *) 	0x00000054) // (PORTSC) 
+#define INSNREG00       (AT91_CAST(AT91_REG *) 	0x00000090) // (INSNREG00) 
+#define INSNREG01       (AT91_CAST(AT91_REG *) 	0x00000094) // (INSNREG01) 
+#define INSNREG02       (AT91_CAST(AT91_REG *) 	0x00000098) // (INSNREG02) 
+#define INSNREG03       (AT91_CAST(AT91_REG *) 	0x0000009C) // (INSNREG03) 
+#define INSNREG04       (AT91_CAST(AT91_REG *) 	0x000000A0) // (INSNREG04) 
+#define INSNREG05       (AT91_CAST(AT91_REG *) 	0x000000A4) // (INSNREG05) 
+
+#endif
+// -------- VERSION : (UHPHS_EHCI Offset: 0x0)  -------- 
+#define AT91C_UHPHS_CAPLENGTH (0xFF <<  0) // (UHPHS_EHCI) CapLength : Offset for control registers
+#define AT91C_UHPHS_HCIVERSION (0xFF << 16) // (UHPHS_EHCI) Hci Version
+
+// *****************************************************************************
+//              SOFTWARE API DEFINITION  FOR True Random Generator
+// *****************************************************************************
+#ifndef __ASSEMBLY__
+typedef struct _AT91S_TRNG {
+	AT91_REG	 TRNG_CR; 	// Control Register
+	AT91_REG	 Reserved0[3]; 	// 
+	AT91_REG	 TRNG_IER; 	// Interrupt Enable Register
+	AT91_REG	 TRNG_IDR; 	// Interrupt Disable Register
+	AT91_REG	 TRNG_IMR; 	// Interrupt Mask Register
+	AT91_REG	 TRNG_ISR; 	// Interrupt Status Register
+	AT91_REG	 Reserved1[12]; 	// 
+	AT91_REG	 TRNG_ODATA; 	// Output Data Register
+	AT91_REG	 Reserved2[42]; 	// 
+	AT91_REG	 TRNG_VERSION; 	// TRNG Version Register
+} AT91S_TRNG, *AT91PS_TRNG;
+#else
+#define TRNG_CR         (AT91_CAST(AT91_REG *) 	0x00000000) // (TRNG_CR) Control Register
+#define TRNG_IER        (AT91_CAST(AT91_REG *) 	0x00000010) // (TRNG_IER) Interrupt Enable Register
+#define TRNG_IDR        (AT91_CAST(AT91_REG *) 	0x00000014) // (TRNG_IDR) Interrupt Disable Register
+#define TRNG_IMR        (AT91_CAST(AT91_REG *) 	0x00000018) // (TRNG_IMR) Interrupt Mask Register
+#define TRNG_ISR        (AT91_CAST(AT91_REG *) 	0x0000001C) // (TRNG_ISR) Interrupt Status Register
+#define TRNG_ODATA      (AT91_CAST(AT91_REG *) 	0x00000050) // (TRNG_ODATA) Output Data Register
+#define TRNG_VERSION    (AT91_CAST(AT91_REG *) 	0x000000FC) // (TRNG_VERSION) TRNG Version Register
+
+#endif
+// -------- TRNG_CR : (TRNG Offset: 0x0) Control Register -------- 
+#define AT91C_TRNG_ENABLE     (0x1 <<  0) // (TRNG) Enable TRNG
+// -------- TRNG_IER : (TRNG Offset: 0x10) Interrupt Enable Register -------- 
+#define AT91C_TRNG_DATRDY     (0x1 <<  0) // (TRNG) DATRDY
+// -------- TRNG_IDR : (TRNG Offset: 0x14) Interrupt Disable Register -------- 
+// -------- TRNG_IMR : (TRNG Offset: 0x18) Interrupt Mask Register -------- 
+// -------- TRNG_ISR : (TRNG Offset: 0x1c) Interrupt Status Register -------- 
+
+// *****************************************************************************
+//               REGISTER ADDRESS DEFINITION FOR AT91SAM9G45
+// *****************************************************************************
+// ========== Register definition for SFR peripheral ========== 
+#define AT91C_SFR_INT   (AT91_CAST(AT91_REG *) 	0xFFF74014) // (SFR) OHCI suspend Interrupt status
+#define AT91C_SFR_DDRCFG (AT91_CAST(AT91_REG *) 	0xFFF74004) // (SFR) DDR2 SSTL18 control
+#define AT91C_SFR_UTMICFG (AT91_CAST(AT91_REG *) 	0xFFF74010) // (SFR) UTMI Software Reset, and OHCI suspend interrupt control
+#define AT91C_SFR_EBIDELAY (AT91_CAST(AT91_REG *) 	0xFFF7400C) // (SFR) EBI DDR controller clock delay
+#define AT91C_SFR_DDRDELAY (AT91_CAST(AT91_REG *) 	0xFFF74008) // (SFR) DDR2 controller clock delay
+#define AT91C_SFR_EMA   (AT91_CAST(AT91_REG *) 	0xFFF74000) // (SFR) memory Extra Margin Adjustment control
+// ========== Register definition for SYS peripheral ========== 
+#define AT91C_SYS_SLCKSEL (AT91_CAST(AT91_REG *) 	0xFFFFFD50) // (SYS) Slow Clock Selection Register
+#define AT91C_SYS_GPBR  (AT91_CAST(AT91_REG *) 	0xFFFFFD60) // (SYS) General Purpose Register
+// ========== Register definition for EBI peripheral ========== 
+#define AT91C_EBI_DUMMY (AT91_CAST(AT91_REG *) 	0xFFFFE200) // (EBI) Dummy register - Do not use
+// ========== Register definition for DDR2CP1 peripheral ========== 
+#define AT91C_DDR2CP1_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFE434) // (DDR2CP1) Pad delay2 Register
+#define AT91C_DDR2CP1_RTR (AT91_CAST(AT91_REG *) 	0xFFFFE404) // (DDR2CP1) Refresh Timer Register
+#define AT91C_DDR2CP1_T0PR (AT91_CAST(AT91_REG *) 	0xFFFFE40C) // (DDR2CP1) Timing0 Register
+#define AT91C_DDR2CP1_WPSR (AT91_CAST(AT91_REG *) 	0xFFFFE4E8) // (DDR2CP1) Write Protect Status Register
+#define AT91C_DDR2CP1_DELAY8 (AT91_CAST(AT91_REG *) 	0xFFFFE44C) // (DDR2CP1) Pad delay8 Register
+#define AT91C_DDR2CP1_LPR (AT91_CAST(AT91_REG *) 	0xFFFFE41C) // (DDR2CP1) Low-power Register
+#define AT91C_DDR2CP1_VER (AT91_CAST(AT91_REG *) 	0xFFFFE428) // (DDR2CP1) DLL Version Register
+#define AT91C_DDR2CP1_DELAY7 (AT91_CAST(AT91_REG *) 	0xFFFFE448) // (DDR2CP1) Pad delay7 Register
+#define AT91C_DDR2CP1_CR (AT91_CAST(AT91_REG *) 	0xFFFFE408) // (DDR2CP1) Configuration Register
+#define AT91C_DDR2CP1_WPMR (AT91_CAST(AT91_REG *) 	0xFFFFE4E4) // (DDR2CP1) Write Protect Mode Register
+#define AT91C_DDR2CP1_MR (AT91_CAST(AT91_REG *) 	0xFFFFE400) // (DDR2CP1) Mode Register
+#define AT91C_DDR2CP1_DELAY5 (AT91_CAST(AT91_REG *) 	0xFFFFE440) // (DDR2CP1) Pad delay5 Register
+#define AT91C_DDR2CP1_T2PR (AT91_CAST(AT91_REG *) 	0xFFFFE414) // (DDR2CP1) Timing2 Register
+#define AT91C_DDR2CP1_HS (AT91_CAST(AT91_REG *) 	0xFFFFE42C) // (DDR2CP1) High Speed Register
+#define AT91C_DDR2CP1_MDR (AT91_CAST(AT91_REG *) 	0xFFFFE420) // (DDR2CP1) Memory Device Register
+#define AT91C_DDR2CP1_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFE43C) // (DDR2CP1) Pad delay4 Register
+#define AT91C_DDR2CP1_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFE430) // (DDR2CP1) Pad delay1 Register
+#define AT91C_DDR2CP1_DELAY6 (AT91_CAST(AT91_REG *) 	0xFFFFE444) // (DDR2CP1) Pad delay6 Register
+#define AT91C_DDR2CP1_DLL (AT91_CAST(AT91_REG *) 	0xFFFFE424) // (DDR2CP1) DLL Information Register
+#define AT91C_DDR2CP1_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFE438) // (DDR2CP1) Pad delay3 Register
+#define AT91C_DDR2CP1_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFE4FC) // (DDR2CP1) Version Register
+#define AT91C_DDR2CP1_T1PR (AT91_CAST(AT91_REG *) 	0xFFFFE410) // (DDR2CP1) Timing1 Register
+// ========== Register definition for DDR2C peripheral ========== 
+#define AT91C_DDR2C_DELAY8 (AT91_CAST(AT91_REG *) 	0xFFFFE64C) // (DDR2C) Pad delay8 Register
+#define AT91C_DDR2C_VER (AT91_CAST(AT91_REG *) 	0xFFFFE628) // (DDR2C) DLL Version Register
+#define AT91C_DDR2C_RTR (AT91_CAST(AT91_REG *) 	0xFFFFE604) // (DDR2C) Refresh Timer Register
+#define AT91C_DDR2C_T0PR (AT91_CAST(AT91_REG *) 	0xFFFFE60C) // (DDR2C) Timing0 Register
+#define AT91C_DDR2C_DELAY5 (AT91_CAST(AT91_REG *) 	0xFFFFE640) // (DDR2C) Pad delay5 Register
+#define AT91C_DDR2C_LPR (AT91_CAST(AT91_REG *) 	0xFFFFE61C) // (DDR2C) Low-power Register
+#define AT91C_DDR2C_HS  (AT91_CAST(AT91_REG *) 	0xFFFFE62C) // (DDR2C) High Speed Register
+#define AT91C_DDR2C_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFE634) // (DDR2C) Pad delay2 Register
+#define AT91C_DDR2C_T2PR (AT91_CAST(AT91_REG *) 	0xFFFFE614) // (DDR2C) Timing2 Register
+#define AT91C_DDR2C_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFE630) // (DDR2C) Pad delay1 Register
+#define AT91C_DDR2C_T1PR (AT91_CAST(AT91_REG *) 	0xFFFFE610) // (DDR2C) Timing1 Register
+#define AT91C_DDR2C_MDR (AT91_CAST(AT91_REG *) 	0xFFFFE620) // (DDR2C) Memory Device Register
+#define AT91C_DDR2C_DELAY6 (AT91_CAST(AT91_REG *) 	0xFFFFE644) // (DDR2C) Pad delay6 Register
+#define AT91C_DDR2C_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFE6FC) // (DDR2C) Version Register
+#define AT91C_DDR2C_MR  (AT91_CAST(AT91_REG *) 	0xFFFFE600) // (DDR2C) Mode Register
+#define AT91C_DDR2C_DLL (AT91_CAST(AT91_REG *) 	0xFFFFE624) // (DDR2C) DLL Information Register
+#define AT91C_DDR2C_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFE63C) // (DDR2C) Pad delay4 Register
+#define AT91C_DDR2C_WPMR (AT91_CAST(AT91_REG *) 	0xFFFFE6E4) // (DDR2C) Write Protect Mode Register
+#define AT91C_DDR2C_CR  (AT91_CAST(AT91_REG *) 	0xFFFFE608) // (DDR2C) Configuration Register
+#define AT91C_DDR2C_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFE638) // (DDR2C) Pad delay3 Register
+#define AT91C_DDR2C_WPSR (AT91_CAST(AT91_REG *) 	0xFFFFE6E8) // (DDR2C) Write Protect Status Register
+#define AT91C_DDR2C_DELAY7 (AT91_CAST(AT91_REG *) 	0xFFFFE648) // (DDR2C) Pad delay7 Register
+// ========== Register definition for SMC peripheral ========== 
+#define AT91C_SMC_PULSE7 (AT91_CAST(AT91_REG *) 	0xFFFFE874) // (SMC)  Pulse Register for CS 7
+#define AT91C_SMC_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFE8C0) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_CYCLE2 (AT91_CAST(AT91_REG *) 	0xFFFFE828) // (SMC)  Cycle Register for CS 2
+#define AT91C_SMC_DELAY5 (AT91_CAST(AT91_REG *) 	0xFFFFE8D0) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_DELAY6 (AT91_CAST(AT91_REG *) 	0xFFFFE8D4) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_PULSE2 (AT91_CAST(AT91_REG *) 	0xFFFFE824) // (SMC)  Pulse Register for CS 2
+#define AT91C_SMC_SETUP6 (AT91_CAST(AT91_REG *) 	0xFFFFE860) // (SMC)  Setup Register for CS 6
+#define AT91C_SMC_SETUP5 (AT91_CAST(AT91_REG *) 	0xFFFFE850) // (SMC)  Setup Register for CS 5
+#define AT91C_SMC_CYCLE6 (AT91_CAST(AT91_REG *) 	0xFFFFE868) // (SMC)  Cycle Register for CS 6
+#define AT91C_SMC_PULSE6 (AT91_CAST(AT91_REG *) 	0xFFFFE864) // (SMC)  Pulse Register for CS 6
+#define AT91C_SMC_CTRL5 (AT91_CAST(AT91_REG *) 	0xFFFFE85C) // (SMC)  Control Register for CS 5
+#define AT91C_SMC_CTRL3 (AT91_CAST(AT91_REG *) 	0xFFFFE83C) // (SMC)  Control Register for CS 3
+#define AT91C_SMC_DELAY7 (AT91_CAST(AT91_REG *) 	0xFFFFE8D8) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFE8C8) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_CYCLE0 (AT91_CAST(AT91_REG *) 	0xFFFFE808) // (SMC)  Cycle Register for CS 0
+#define AT91C_SMC_SETUP1 (AT91_CAST(AT91_REG *) 	0xFFFFE810) // (SMC)  Setup Register for CS 1
+#define AT91C_SMC_PULSE5 (AT91_CAST(AT91_REG *) 	0xFFFFE854) // (SMC)  Pulse Register for CS 5
+#define AT91C_SMC_SETUP7 (AT91_CAST(AT91_REG *) 	0xFFFFE870) // (SMC)  Setup Register for CS 7
+#define AT91C_SMC_CTRL4 (AT91_CAST(AT91_REG *) 	0xFFFFE84C) // (SMC)  Control Register for CS 4
+#define AT91C_SMC_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFE8C4) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_PULSE3 (AT91_CAST(AT91_REG *) 	0xFFFFE834) // (SMC)  Pulse Register for CS 3
+#define AT91C_SMC_CYCLE4 (AT91_CAST(AT91_REG *) 	0xFFFFE848) // (SMC)  Cycle Register for CS 4
+#define AT91C_SMC_CTRL1 (AT91_CAST(AT91_REG *) 	0xFFFFE81C) // (SMC)  Control Register for CS 1
+#define AT91C_SMC_SETUP3 (AT91_CAST(AT91_REG *) 	0xFFFFE830) // (SMC)  Setup Register for CS 3
+#define AT91C_SMC_CTRL0 (AT91_CAST(AT91_REG *) 	0xFFFFE80C) // (SMC)  Control Register for CS 0
+#define AT91C_SMC_CYCLE7 (AT91_CAST(AT91_REG *) 	0xFFFFE878) // (SMC)  Cycle Register for CS 7
+#define AT91C_SMC_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFE8CC) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_CYCLE1 (AT91_CAST(AT91_REG *) 	0xFFFFE818) // (SMC)  Cycle Register for CS 1
+#define AT91C_SMC_SETUP2 (AT91_CAST(AT91_REG *) 	0xFFFFE820) // (SMC)  Setup Register for CS 2
+#define AT91C_SMC_PULSE1 (AT91_CAST(AT91_REG *) 	0xFFFFE814) // (SMC)  Pulse Register for CS 1
+#define AT91C_SMC_DELAY8 (AT91_CAST(AT91_REG *) 	0xFFFFE8DC) // (SMC) SMC Delay Control Register
+#define AT91C_SMC_CTRL2 (AT91_CAST(AT91_REG *) 	0xFFFFE82C) // (SMC)  Control Register for CS 2
+#define AT91C_SMC_PULSE4 (AT91_CAST(AT91_REG *) 	0xFFFFE844) // (SMC)  Pulse Register for CS 4
+#define AT91C_SMC_SETUP4 (AT91_CAST(AT91_REG *) 	0xFFFFE840) // (SMC)  Setup Register for CS 4
+#define AT91C_SMC_CYCLE3 (AT91_CAST(AT91_REG *) 	0xFFFFE838) // (SMC)  Cycle Register for CS 3
+#define AT91C_SMC_SETUP0 (AT91_CAST(AT91_REG *) 	0xFFFFE800) // (SMC)  Setup Register for CS 0
+#define AT91C_SMC_CYCLE5 (AT91_CAST(AT91_REG *) 	0xFFFFE858) // (SMC)  Cycle Register for CS 5
+#define AT91C_SMC_PULSE0 (AT91_CAST(AT91_REG *) 	0xFFFFE804) // (SMC)  Pulse Register for CS 0
+#define AT91C_SMC_CTRL6 (AT91_CAST(AT91_REG *) 	0xFFFFE86C) // (SMC)  Control Register for CS 6
+#define AT91C_SMC_CTRL7 (AT91_CAST(AT91_REG *) 	0xFFFFE87C) // (SMC)  Control Register for CS 7
+// ========== Register definition for MATRIX peripheral ========== 
+#define AT91C_MATRIX_SCFG1 (AT91_CAST(AT91_REG *) 	0xFFFFEA44) // (MATRIX)  Slave Configuration Register 1 : SRAM S1
+#define AT91C_MATRIX_MRCR (AT91_CAST(AT91_REG *) 	0xFFFFEB00) // (MATRIX)  Master Remap Control Register 
+#define AT91C_MATRIX_PRAS2 (AT91_CAST(AT91_REG *) 	0xFFFFEA90) // (MATRIX)  PRAS2 : SRAM S2
+#define AT91C_MATRIX_PRAS1 (AT91_CAST(AT91_REG *) 	0xFFFFEA88) // (MATRIX)  PRAS1 : SRAM S1
+#define AT91C_MATRIX_PRAS0 (AT91_CAST(AT91_REG *) 	0xFFFFEA80) // (MATRIX)  PRAS0 : SRAM S0
+#define AT91C_MATRIX_MCFG8 (AT91_CAST(AT91_REG *) 	0xFFFFEA20) // (MATRIX)  Master Configuration Register 8 : eMAC
+#define AT91C_MATRIX_MCFG2 (AT91_CAST(AT91_REG *) 	0xFFFFEA08) // (MATRIX)  Master Configuration Register 2 : pdc
+#define AT91C_MATRIX_EBICSA (AT91_CAST(AT91_REG *) 	0xFFFFEB28) // (MATRIX)  EBI Chip Select Assignment Register 
+#define AT91C_MATRIX_PRAS4 (AT91_CAST(AT91_REG *) 	0xFFFFEAA0) // (MATRIX)  PRAS4 : ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+#define AT91C_MATRIX_MCFG3 (AT91_CAST(AT91_REG *) 	0xFFFFEA0C) // (MATRIX)  Master Configuration Register 3 : USB Host OHCI
+#define AT91C_MATRIX_SCFG0 (AT91_CAST(AT91_REG *) 	0xFFFFEA40) // (MATRIX)  Slave Configuration Register 0 : SRAM S0
+#define AT91C_MATRIX_MCFG7 (AT91_CAST(AT91_REG *) 	0xFFFFEA1C) // (MATRIX)  Master Configuration Register 7 : lcdc
+#define AT91C_MATRIX_PRAS6 (AT91_CAST(AT91_REG *) 	0xFFFFEAB0) // (MATRIX)  PRAS6 : DDR2 S1
+#define AT91C_MATRIX_SCFG7 (AT91_CAST(AT91_REG *) 	0xFFFFEA5C) // (MATRIX)  Slave Configuration Register 7 : DDR2 S2
+#define AT91C_MATRIX_PRAS7 (AT91_CAST(AT91_REG *) 	0xFFFFEAB8) // (MATRIX)  PRAS7 : DDR2 S2
+#define AT91C_MATRIX_SCFG2 (AT91_CAST(AT91_REG *) 	0xFFFFEA48) // (MATRIX)  Slave Configuration Register 2 : SRAM S2
+#define AT91C_MATRIX_WRPROTST (AT91_CAST(AT91_REG *) 	0xFFFFEBE8) // (MATRIX)  Write Protection Status Register 
+#define AT91C_MATRIX_PRBS0 (AT91_CAST(AT91_REG *) 	0xFFFFEA84) // (MATRIX)  PRBS0 : SRAM S0
+#define AT91C_MATRIX_PRBS2 (AT91_CAST(AT91_REG *) 	0xFFFFEA94) // (MATRIX)  PRBS2 : SRAM S2
+#define AT91C_MATRIX_MCFG4 (AT91_CAST(AT91_REG *) 	0xFFFFEA10) // (MATRIX)  Master Configuration Register 4 : DMA0
+#define AT91C_MATRIX_SCFG5 (AT91_CAST(AT91_REG *) 	0xFFFFEA54) // (MATRIX)  Slave Configuration Register 5 : DDR2 S0
+#define AT91C_MATRIX_PRBS6 (AT91_CAST(AT91_REG *) 	0xFFFFEAB4) // (MATRIX)  PRBS6 : DDR2 S1
+#define AT91C_MATRIX_MCFG1 (AT91_CAST(AT91_REG *) 	0xFFFFEA04) // (MATRIX)  Master Configuration Register 1 ; ARM-D
+#define AT91C_MATRIX_SCFG6 (AT91_CAST(AT91_REG *) 	0xFFFFEA58) // (MATRIX)  Slave Configuration Register 6 : DDR2 S1
+#define AT91C_MATRIX_SCFG4 (AT91_CAST(AT91_REG *) 	0xFFFFEA50) // (MATRIX)  Slave Configuration Register 4 ; ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+#define AT91C_MATRIX_PRBS1 (AT91_CAST(AT91_REG *) 	0xFFFFEA8C) // (MATRIX)  PRBS1 : SRAM S1
+#define AT91C_MATRIX_PRBS3 (AT91_CAST(AT91_REG *) 	0xFFFFEA9C) // (MATRIX)  PRBS3 : SRAM S3
+#define AT91C_MATRIX_WRPROTEN (AT91_CAST(AT91_REG *) 	0xFFFFEBE4) // (MATRIX)  Write Protection Control Register 
+#define AT91C_MATRIX_TCMR (AT91_CAST(AT91_REG *) 	0xFFFFEB10) // (MATRIX)  Bus Matrix TCM Configuration Register 
+#define AT91C_MATRIX_MCFG0 (AT91_CAST(AT91_REG *) 	0xFFFFEA00) // (MATRIX)  Master Configuration Register 0 : ARM-I
+#define AT91C_MATRIX_PRAS5 (AT91_CAST(AT91_REG *) 	0xFFFFEAA8) // (MATRIX)  PRAS5 : DDR2 S0
+#define AT91C_MATRIX_DDRMPR (AT91_CAST(AT91_REG *) 	0xFFFFEB18) // (MATRIX)  DDR Multi-Port Register 
+#define AT91C_MATRIX_PRBS4 (AT91_CAST(AT91_REG *) 	0xFFFFEAA4) // (MATRIX)  PRBS4 : ROM + USB Dev + USB EHCI + USB OHCI + LCD + Video Decoder
+#define AT91C_MATRIX_MCFG6 (AT91_CAST(AT91_REG *) 	0xFFFFEA18) // (MATRIX)  Master Configuration Register 6 : hisi
+#define AT91C_MATRIX_PRBS5 (AT91_CAST(AT91_REG *) 	0xFFFFEAAC) // (MATRIX)  PRBS5 : DDR2 S0
+#define AT91C_MATRIX_MCFG9 (AT91_CAST(AT91_REG *) 	0xFFFFEA24) // (MATRIX)  Master Configuration Register 9 : USB Device
+#define AT91C_MATRIX_MCFG5 (AT91_CAST(AT91_REG *) 	0xFFFFEA14) // (MATRIX)  Master Configuration Register 5 : DMA1
+#define AT91C_MATRIX_PRBS7 (AT91_CAST(AT91_REG *) 	0xFFFFEABC) // (MATRIX)  PRBS7 : DDR2 S2
+#define AT91C_MATRIX_MCFG10 (AT91_CAST(AT91_REG *) 	0xFFFFEA28) // (MATRIX)  Master Configuration Register 10 : USB Host EHCI
+#define AT91C_MATRIX_PRAS3 (AT91_CAST(AT91_REG *) 	0xFFFFEA98) // (MATRIX)  PRAS3 : SRAM S3
+#define AT91C_MATRIX_SCFG3 (AT91_CAST(AT91_REG *) 	0xFFFFEA4C) // (MATRIX)  Slave Configuration Register 3 : SRAM S3
+// ========== Register definition for AIC peripheral ========== 
+#define AT91C_AIC_IVR   (AT91_CAST(AT91_REG *) 	0xFFFFF100) // (AIC) IRQ Vector Register
+#define AT91C_AIC_SMR   (AT91_CAST(AT91_REG *) 	0xFFFFF000) // (AIC) Source Mode Register
+#define AT91C_AIC_FVR   (AT91_CAST(AT91_REG *) 	0xFFFFF104) // (AIC) FIQ Vector Register
+#define AT91C_AIC_DCR   (AT91_CAST(AT91_REG *) 	0xFFFFF138) // (AIC) Debug Control Register (Protect)
+#define AT91C_AIC_EOICR (AT91_CAST(AT91_REG *) 	0xFFFFF130) // (AIC) End of Interrupt Command Register
+#define AT91C_AIC_SVR   (AT91_CAST(AT91_REG *) 	0xFFFFF080) // (AIC) Source Vector Register
+#define AT91C_AIC_FFSR  (AT91_CAST(AT91_REG *) 	0xFFFFF148) // (AIC) Fast Forcing Status Register
+#define AT91C_AIC_ICCR  (AT91_CAST(AT91_REG *) 	0xFFFFF128) // (AIC) Interrupt Clear Command Register
+#define AT91C_AIC_ISR   (AT91_CAST(AT91_REG *) 	0xFFFFF108) // (AIC) Interrupt Status Register
+#define AT91C_AIC_IMR   (AT91_CAST(AT91_REG *) 	0xFFFFF110) // (AIC) Interrupt Mask Register
+#define AT91C_AIC_IPR   (AT91_CAST(AT91_REG *) 	0xFFFFF10C) // (AIC) Interrupt Pending Register
+#define AT91C_AIC_FFER  (AT91_CAST(AT91_REG *) 	0xFFFFF140) // (AIC) Fast Forcing Enable Register
+#define AT91C_AIC_IECR  (AT91_CAST(AT91_REG *) 	0xFFFFF120) // (AIC) Interrupt Enable Command Register
+#define AT91C_AIC_ISCR  (AT91_CAST(AT91_REG *) 	0xFFFFF12C) // (AIC) Interrupt Set Command Register
+#define AT91C_AIC_FFDR  (AT91_CAST(AT91_REG *) 	0xFFFFF144) // (AIC) Fast Forcing Disable Register
+#define AT91C_AIC_CISR  (AT91_CAST(AT91_REG *) 	0xFFFFF114) // (AIC) Core Interrupt Status Register
+#define AT91C_AIC_IDCR  (AT91_CAST(AT91_REG *) 	0xFFFFF124) // (AIC) Interrupt Disable Command Register
+#define AT91C_AIC_SPU   (AT91_CAST(AT91_REG *) 	0xFFFFF134) // (AIC) Spurious Vector Register
+// ========== Register definition for PDC_DBGU peripheral ========== 
+#define AT91C_DBGU_PTCR (AT91_CAST(AT91_REG *) 	0xFFFFEF20) // (PDC_DBGU) PDC Transfer Control Register
+#define AT91C_DBGU_RCR  (AT91_CAST(AT91_REG *) 	0xFFFFEF04) // (PDC_DBGU) Receive Counter Register
+#define AT91C_DBGU_TCR  (AT91_CAST(AT91_REG *) 	0xFFFFEF0C) // (PDC_DBGU) Transmit Counter Register
+#define AT91C_DBGU_RNCR (AT91_CAST(AT91_REG *) 	0xFFFFEF14) // (PDC_DBGU) Receive Next Counter Register
+#define AT91C_DBGU_TNPR (AT91_CAST(AT91_REG *) 	0xFFFFEF18) // (PDC_DBGU) Transmit Next Pointer Register
+#define AT91C_DBGU_RNPR (AT91_CAST(AT91_REG *) 	0xFFFFEF10) // (PDC_DBGU) Receive Next Pointer Register
+#define AT91C_DBGU_PTSR (AT91_CAST(AT91_REG *) 	0xFFFFEF24) // (PDC_DBGU) PDC Transfer Status Register
+#define AT91C_DBGU_RPR  (AT91_CAST(AT91_REG *) 	0xFFFFEF00) // (PDC_DBGU) Receive Pointer Register
+#define AT91C_DBGU_TPR  (AT91_CAST(AT91_REG *) 	0xFFFFEF08) // (PDC_DBGU) Transmit Pointer Register
+#define AT91C_DBGU_TNCR (AT91_CAST(AT91_REG *) 	0xFFFFEF1C) // (PDC_DBGU) Transmit Next Counter Register
+// ========== Register definition for DBGU peripheral ========== 
+#define AT91C_DBGU_BRGR (AT91_CAST(AT91_REG *) 	0xFFFFEE20) // (DBGU) Baud Rate Generator Register
+#define AT91C_DBGU_CR   (AT91_CAST(AT91_REG *) 	0xFFFFEE00) // (DBGU) Control Register
+#define AT91C_DBGU_THR  (AT91_CAST(AT91_REG *) 	0xFFFFEE1C) // (DBGU) Transmitter Holding Register
+#define AT91C_DBGU_IDR  (AT91_CAST(AT91_REG *) 	0xFFFFEE0C) // (DBGU) Interrupt Disable Register
+#define AT91C_DBGU_EXID (AT91_CAST(AT91_REG *) 	0xFFFFEE44) // (DBGU) Chip ID Extension Register
+#define AT91C_DBGU_IMR  (AT91_CAST(AT91_REG *) 	0xFFFFEE10) // (DBGU) Interrupt Mask Register
+#define AT91C_DBGU_FNTR (AT91_CAST(AT91_REG *) 	0xFFFFEE48) // (DBGU) Force NTRST Register
+#define AT91C_DBGU_IER  (AT91_CAST(AT91_REG *) 	0xFFFFEE08) // (DBGU) Interrupt Enable Register
+#define AT91C_DBGU_CSR  (AT91_CAST(AT91_REG *) 	0xFFFFEE14) // (DBGU) Channel Status Register
+#define AT91C_DBGU_MR   (AT91_CAST(AT91_REG *) 	0xFFFFEE04) // (DBGU) Mode Register
+#define AT91C_DBGU_RHR  (AT91_CAST(AT91_REG *) 	0xFFFFEE18) // (DBGU) Receiver Holding Register
+#define AT91C_DBGU_CIDR (AT91_CAST(AT91_REG *) 	0xFFFFEE40) // (DBGU) Chip ID Register
+// ========== Register definition for PIOA peripheral ========== 
+#define AT91C_PIOA_OWDR (AT91_CAST(AT91_REG *) 	0xFFFFF2A4) // (PIOA) Output Write Disable Register
+#define AT91C_PIOA_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFF2C8) // (PIOA) PIO Delay Control Register
+#define AT91C_PIOA_ISR  (AT91_CAST(AT91_REG *) 	0xFFFFF24C) // (PIOA) Interrupt Status Register
+#define AT91C_PIOA_PDR  (AT91_CAST(AT91_REG *) 	0xFFFFF204) // (PIOA) PIO Disable Register
+#define AT91C_PIOA_OSR  (AT91_CAST(AT91_REG *) 	0xFFFFF218) // (PIOA) Output Status Register
+#define AT91C_PIOA_ABSR (AT91_CAST(AT91_REG *) 	0xFFFFF278) // (PIOA) AB Select Status Register
+#define AT91C_PIOA_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFF2C4) // (PIOA) PIO Delay Control Register
+#define AT91C_PIOA_PDSR (AT91_CAST(AT91_REG *) 	0xFFFFF23C) // (PIOA) Pin Data Status Register
+#define AT91C_PIOA_BSR  (AT91_CAST(AT91_REG *) 	0xFFFFF274) // (PIOA) Select B Register
+#define AT91C_PIOA_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFF2C0) // (PIOA) PIO Delay Control Register
+#define AT91C_PIOA_PPUER (AT91_CAST(AT91_REG *) 	0xFFFFF264) // (PIOA) Pull-up Enable Register
+#define AT91C_PIOA_OER  (AT91_CAST(AT91_REG *) 	0xFFFFF210) // (PIOA) Output Enable Register
+#define AT91C_PIOA_PER  (AT91_CAST(AT91_REG *) 	0xFFFFF200) // (PIOA) PIO Enable Register
+#define AT91C_PIOA_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFF2FC) // (PIOA) PIO Version Register
+#define AT91C_PIOA_PPUDR (AT91_CAST(AT91_REG *) 	0xFFFFF260) // (PIOA) Pull-up Disable Register
+#define AT91C_PIOA_ODSR (AT91_CAST(AT91_REG *) 	0xFFFFF238) // (PIOA) Output Data Status Register
+#define AT91C_PIOA_SLEWRATE1 (AT91_CAST(AT91_REG *) 	0xFFFFF2B0) // (PIOA) PIO Slewrate Control Register
+#define AT91C_PIOA_MDDR (AT91_CAST(AT91_REG *) 	0xFFFFF254) // (PIOA) Multi-driver Disable Register
+#define AT91C_PIOA_IFSR (AT91_CAST(AT91_REG *) 	0xFFFFF228) // (PIOA) Input Filter Status Register
+#define AT91C_PIOA_CODR (AT91_CAST(AT91_REG *) 	0xFFFFF234) // (PIOA) Clear Output Data Register
+#define AT91C_PIOA_ASR  (AT91_CAST(AT91_REG *) 	0xFFFFF270) // (PIOA) Select A Register
+#define AT91C_PIOA_OWSR (AT91_CAST(AT91_REG *) 	0xFFFFF2A8) // (PIOA) Output Write Status Register
+#define AT91C_PIOA_IMR  (AT91_CAST(AT91_REG *) 	0xFFFFF248) // (PIOA) Interrupt Mask Register
+#define AT91C_PIOA_PPUSR (AT91_CAST(AT91_REG *) 	0xFFFFF268) // (PIOA) Pull-up Status Register
+#define AT91C_PIOA_MDER (AT91_CAST(AT91_REG *) 	0xFFFFF250) // (PIOA) Multi-driver Enable Register
+#define AT91C_PIOA_IFDR (AT91_CAST(AT91_REG *) 	0xFFFFF224) // (PIOA) Input Filter Disable Register
+#define AT91C_PIOA_SODR (AT91_CAST(AT91_REG *) 	0xFFFFF230) // (PIOA) Set Output Data Register
+#define AT91C_PIOA_OWER (AT91_CAST(AT91_REG *) 	0xFFFFF2A0) // (PIOA) Output Write Enable Register
+#define AT91C_PIOA_IDR  (AT91_CAST(AT91_REG *) 	0xFFFFF244) // (PIOA) Interrupt Disable Register
+#define AT91C_PIOA_IFER (AT91_CAST(AT91_REG *) 	0xFFFFF220) // (PIOA) Input Filter Enable Register
+#define AT91C_PIOA_IER  (AT91_CAST(AT91_REG *) 	0xFFFFF240) // (PIOA) Interrupt Enable Register
+#define AT91C_PIOA_ODR  (AT91_CAST(AT91_REG *) 	0xFFFFF214) // (PIOA) Output Disable Registerr
+#define AT91C_PIOA_MDSR (AT91_CAST(AT91_REG *) 	0xFFFFF258) // (PIOA) Multi-driver Status Register
+#define AT91C_PIOA_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFF2CC) // (PIOA) PIO Delay Control Register
+#define AT91C_PIOA_PSR  (AT91_CAST(AT91_REG *) 	0xFFFFF208) // (PIOA) PIO Status Register
+// ========== Register definition for PIOB peripheral ========== 
+#define AT91C_PIOB_ODR  (AT91_CAST(AT91_REG *) 	0xFFFFF414) // (PIOB) Output Disable Registerr
+#define AT91C_PIOB_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFF4CC) // (PIOB) PIO Delay Control Register
+#define AT91C_PIOB_SODR (AT91_CAST(AT91_REG *) 	0xFFFFF430) // (PIOB) Set Output Data Register
+#define AT91C_PIOB_ISR  (AT91_CAST(AT91_REG *) 	0xFFFFF44C) // (PIOB) Interrupt Status Register
+#define AT91C_PIOB_ABSR (AT91_CAST(AT91_REG *) 	0xFFFFF478) // (PIOB) AB Select Status Register
+#define AT91C_PIOB_IMR  (AT91_CAST(AT91_REG *) 	0xFFFFF448) // (PIOB) Interrupt Mask Register
+#define AT91C_PIOB_MDSR (AT91_CAST(AT91_REG *) 	0xFFFFF458) // (PIOB) Multi-driver Status Register
+#define AT91C_PIOB_PPUSR (AT91_CAST(AT91_REG *) 	0xFFFFF468) // (PIOB) Pull-up Status Register
+#define AT91C_PIOB_PDSR (AT91_CAST(AT91_REG *) 	0xFFFFF43C) // (PIOB) Pin Data Status Register
+#define AT91C_PIOB_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFF4C8) // (PIOB) PIO Delay Control Register
+#define AT91C_PIOB_MDDR (AT91_CAST(AT91_REG *) 	0xFFFFF454) // (PIOB) Multi-driver Disable Register
+#define AT91C_PIOB_CODR (AT91_CAST(AT91_REG *) 	0xFFFFF434) // (PIOB) Clear Output Data Register
+#define AT91C_PIOB_MDER (AT91_CAST(AT91_REG *) 	0xFFFFF450) // (PIOB) Multi-driver Enable Register
+#define AT91C_PIOB_PDR  (AT91_CAST(AT91_REG *) 	0xFFFFF404) // (PIOB) PIO Disable Register
+#define AT91C_PIOB_IFSR (AT91_CAST(AT91_REG *) 	0xFFFFF428) // (PIOB) Input Filter Status Register
+#define AT91C_PIOB_PSR  (AT91_CAST(AT91_REG *) 	0xFFFFF408) // (PIOB) PIO Status Register
+#define AT91C_PIOB_SLEWRATE1 (AT91_CAST(AT91_REG *) 	0xFFFFF4B0) // (PIOB) PIO Slewrate Control Register
+#define AT91C_PIOB_IER  (AT91_CAST(AT91_REG *) 	0xFFFFF440) // (PIOB) Interrupt Enable Register
+#define AT91C_PIOB_PPUDR (AT91_CAST(AT91_REG *) 	0xFFFFF460) // (PIOB) Pull-up Disable Register
+#define AT91C_PIOB_PER  (AT91_CAST(AT91_REG *) 	0xFFFFF400) // (PIOB) PIO Enable Register
+#define AT91C_PIOB_IFDR (AT91_CAST(AT91_REG *) 	0xFFFFF424) // (PIOB) Input Filter Disable Register
+#define AT91C_PIOB_IDR  (AT91_CAST(AT91_REG *) 	0xFFFFF444) // (PIOB) Interrupt Disable Register
+#define AT91C_PIOB_OWDR (AT91_CAST(AT91_REG *) 	0xFFFFF4A4) // (PIOB) Output Write Disable Register
+#define AT91C_PIOB_ODSR (AT91_CAST(AT91_REG *) 	0xFFFFF438) // (PIOB) Output Data Status Register
+#define AT91C_PIOB_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFF4C4) // (PIOB) PIO Delay Control Register
+#define AT91C_PIOB_OWSR (AT91_CAST(AT91_REG *) 	0xFFFFF4A8) // (PIOB) Output Write Status Register
+#define AT91C_PIOB_BSR  (AT91_CAST(AT91_REG *) 	0xFFFFF474) // (PIOB) Select B Register
+#define AT91C_PIOB_IFER (AT91_CAST(AT91_REG *) 	0xFFFFF420) // (PIOB) Input Filter Enable Register
+#define AT91C_PIOB_OWER (AT91_CAST(AT91_REG *) 	0xFFFFF4A0) // (PIOB) Output Write Enable Register
+#define AT91C_PIOB_PPUER (AT91_CAST(AT91_REG *) 	0xFFFFF464) // (PIOB) Pull-up Enable Register
+#define AT91C_PIOB_OSR  (AT91_CAST(AT91_REG *) 	0xFFFFF418) // (PIOB) Output Status Register
+#define AT91C_PIOB_ASR  (AT91_CAST(AT91_REG *) 	0xFFFFF470) // (PIOB) Select A Register
+#define AT91C_PIOB_OER  (AT91_CAST(AT91_REG *) 	0xFFFFF410) // (PIOB) Output Enable Register
+#define AT91C_PIOB_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFF4FC) // (PIOB) PIO Version Register
+#define AT91C_PIOB_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFF4C0) // (PIOB) PIO Delay Control Register
+// ========== Register definition for PIOC peripheral ========== 
+#define AT91C_PIOC_OWDR (AT91_CAST(AT91_REG *) 	0xFFFFF6A4) // (PIOC) Output Write Disable Register
+#define AT91C_PIOC_IMR  (AT91_CAST(AT91_REG *) 	0xFFFFF648) // (PIOC) Interrupt Mask Register
+#define AT91C_PIOC_ASR  (AT91_CAST(AT91_REG *) 	0xFFFFF670) // (PIOC) Select A Register
+#define AT91C_PIOC_PPUDR (AT91_CAST(AT91_REG *) 	0xFFFFF660) // (PIOC) Pull-up Disable Register
+#define AT91C_PIOC_CODR (AT91_CAST(AT91_REG *) 	0xFFFFF634) // (PIOC) Clear Output Data Register
+#define AT91C_PIOC_OWER (AT91_CAST(AT91_REG *) 	0xFFFFF6A0) // (PIOC) Output Write Enable Register
+#define AT91C_PIOC_ABSR (AT91_CAST(AT91_REG *) 	0xFFFFF678) // (PIOC) AB Select Status Register
+#define AT91C_PIOC_IFDR (AT91_CAST(AT91_REG *) 	0xFFFFF624) // (PIOC) Input Filter Disable Register
+#define AT91C_PIOC_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFF6FC) // (PIOC) PIO Version Register
+#define AT91C_PIOC_ODR  (AT91_CAST(AT91_REG *) 	0xFFFFF614) // (PIOC) Output Disable Registerr
+#define AT91C_PIOC_PPUER (AT91_CAST(AT91_REG *) 	0xFFFFF664) // (PIOC) Pull-up Enable Register
+#define AT91C_PIOC_SODR (AT91_CAST(AT91_REG *) 	0xFFFFF630) // (PIOC) Set Output Data Register
+#define AT91C_PIOC_ISR  (AT91_CAST(AT91_REG *) 	0xFFFFF64C) // (PIOC) Interrupt Status Register
+#define AT91C_PIOC_OSR  (AT91_CAST(AT91_REG *) 	0xFFFFF618) // (PIOC) Output Status Register
+#define AT91C_PIOC_MDSR (AT91_CAST(AT91_REG *) 	0xFFFFF658) // (PIOC) Multi-driver Status Register
+#define AT91C_PIOC_IFER (AT91_CAST(AT91_REG *) 	0xFFFFF620) // (PIOC) Input Filter Enable Register
+#define AT91C_PIOC_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFF6C4) // (PIOC) PIO Delay Control Register
+#define AT91C_PIOC_MDER (AT91_CAST(AT91_REG *) 	0xFFFFF650) // (PIOC) Multi-driver Enable Register
+#define AT91C_PIOC_PPUSR (AT91_CAST(AT91_REG *) 	0xFFFFF668) // (PIOC) Pull-up Status Register
+#define AT91C_PIOC_PSR  (AT91_CAST(AT91_REG *) 	0xFFFFF608) // (PIOC) PIO Status Register
+#define AT91C_PIOC_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFF6CC) // (PIOC) PIO Delay Control Register
+#define AT91C_PIOC_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFF6C8) // (PIOC) PIO Delay Control Register
+#define AT91C_PIOC_IER  (AT91_CAST(AT91_REG *) 	0xFFFFF640) // (PIOC) Interrupt Enable Register
+#define AT91C_PIOC_SLEWRATE1 (AT91_CAST(AT91_REG *) 	0xFFFFF6B0) // (PIOC) PIO Slewrate Control Register
+#define AT91C_PIOC_IDR  (AT91_CAST(AT91_REG *) 	0xFFFFF644) // (PIOC) Interrupt Disable Register
+#define AT91C_PIOC_PDSR (AT91_CAST(AT91_REG *) 	0xFFFFF63C) // (PIOC) Pin Data Status Register
+#define AT91C_PIOC_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFF6C0) // (PIOC) PIO Delay Control Register
+#define AT91C_PIOC_PDR  (AT91_CAST(AT91_REG *) 	0xFFFFF604) // (PIOC) PIO Disable Register
+#define AT91C_PIOC_OWSR (AT91_CAST(AT91_REG *) 	0xFFFFF6A8) // (PIOC) Output Write Status Register
+#define AT91C_PIOC_IFSR (AT91_CAST(AT91_REG *) 	0xFFFFF628) // (PIOC) Input Filter Status Register
+#define AT91C_PIOC_ODSR (AT91_CAST(AT91_REG *) 	0xFFFFF638) // (PIOC) Output Data Status Register
+#define AT91C_PIOC_OER  (AT91_CAST(AT91_REG *) 	0xFFFFF610) // (PIOC) Output Enable Register
+#define AT91C_PIOC_MDDR (AT91_CAST(AT91_REG *) 	0xFFFFF654) // (PIOC) Multi-driver Disable Register
+#define AT91C_PIOC_BSR  (AT91_CAST(AT91_REG *) 	0xFFFFF674) // (PIOC) Select B Register
+#define AT91C_PIOC_PER  (AT91_CAST(AT91_REG *) 	0xFFFFF600) // (PIOC) PIO Enable Register
+// ========== Register definition for PIOD peripheral ========== 
+#define AT91C_PIOD_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFF8C0) // (PIOD) PIO Delay Control Register
+#define AT91C_PIOD_OWDR (AT91_CAST(AT91_REG *) 	0xFFFFF8A4) // (PIOD) Output Write Disable Register
+#define AT91C_PIOD_SODR (AT91_CAST(AT91_REG *) 	0xFFFFF830) // (PIOD) Set Output Data Register
+#define AT91C_PIOD_PPUER (AT91_CAST(AT91_REG *) 	0xFFFFF864) // (PIOD) Pull-up Enable Register
+#define AT91C_PIOD_CODR (AT91_CAST(AT91_REG *) 	0xFFFFF834) // (PIOD) Clear Output Data Register
+#define AT91C_PIOD_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFF8CC) // (PIOD) PIO Delay Control Register
+#define AT91C_PIOD_PSR  (AT91_CAST(AT91_REG *) 	0xFFFFF808) // (PIOD) PIO Status Register
+#define AT91C_PIOD_PDR  (AT91_CAST(AT91_REG *) 	0xFFFFF804) // (PIOD) PIO Disable Register
+#define AT91C_PIOD_ODR  (AT91_CAST(AT91_REG *) 	0xFFFFF814) // (PIOD) Output Disable Registerr
+#define AT91C_PIOD_PPUSR (AT91_CAST(AT91_REG *) 	0xFFFFF868) // (PIOD) Pull-up Status Register
+#define AT91C_PIOD_IFSR (AT91_CAST(AT91_REG *) 	0xFFFFF828) // (PIOD) Input Filter Status Register
+#define AT91C_PIOD_IMR  (AT91_CAST(AT91_REG *) 	0xFFFFF848) // (PIOD) Interrupt Mask Register
+#define AT91C_PIOD_ASR  (AT91_CAST(AT91_REG *) 	0xFFFFF870) // (PIOD) Select A Register
+#define AT91C_PIOD_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFF8C4) // (PIOD) PIO Delay Control Register
+#define AT91C_PIOD_OWSR (AT91_CAST(AT91_REG *) 	0xFFFFF8A8) // (PIOD) Output Write Status Register
+#define AT91C_PIOD_PER  (AT91_CAST(AT91_REG *) 	0xFFFFF800) // (PIOD) PIO Enable Register
+#define AT91C_PIOD_MDER (AT91_CAST(AT91_REG *) 	0xFFFFF850) // (PIOD) Multi-driver Enable Register
+#define AT91C_PIOD_PDSR (AT91_CAST(AT91_REG *) 	0xFFFFF83C) // (PIOD) Pin Data Status Register
+#define AT91C_PIOD_MDSR (AT91_CAST(AT91_REG *) 	0xFFFFF858) // (PIOD) Multi-driver Status Register
+#define AT91C_PIOD_OWER (AT91_CAST(AT91_REG *) 	0xFFFFF8A0) // (PIOD) Output Write Enable Register
+#define AT91C_PIOD_BSR  (AT91_CAST(AT91_REG *) 	0xFFFFF874) // (PIOD) Select B Register
+#define AT91C_PIOD_IFDR (AT91_CAST(AT91_REG *) 	0xFFFFF824) // (PIOD) Input Filter Disable Register
+#define AT91C_PIOD_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFF8C8) // (PIOD) PIO Delay Control Register
+#define AT91C_PIOD_ABSR (AT91_CAST(AT91_REG *) 	0xFFFFF878) // (PIOD) AB Select Status Register
+#define AT91C_PIOD_OER  (AT91_CAST(AT91_REG *) 	0xFFFFF810) // (PIOD) Output Enable Register
+#define AT91C_PIOD_MDDR (AT91_CAST(AT91_REG *) 	0xFFFFF854) // (PIOD) Multi-driver Disable Register
+#define AT91C_PIOD_IDR  (AT91_CAST(AT91_REG *) 	0xFFFFF844) // (PIOD) Interrupt Disable Register
+#define AT91C_PIOD_IER  (AT91_CAST(AT91_REG *) 	0xFFFFF840) // (PIOD) Interrupt Enable Register
+#define AT91C_PIOD_PPUDR (AT91_CAST(AT91_REG *) 	0xFFFFF860) // (PIOD) Pull-up Disable Register
+#define AT91C_PIOD_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFF8FC) // (PIOD) PIO Version Register
+#define AT91C_PIOD_ISR  (AT91_CAST(AT91_REG *) 	0xFFFFF84C) // (PIOD) Interrupt Status Register
+#define AT91C_PIOD_ODSR (AT91_CAST(AT91_REG *) 	0xFFFFF838) // (PIOD) Output Data Status Register
+#define AT91C_PIOD_OSR  (AT91_CAST(AT91_REG *) 	0xFFFFF818) // (PIOD) Output Status Register
+#define AT91C_PIOD_IFER (AT91_CAST(AT91_REG *) 	0xFFFFF820) // (PIOD) Input Filter Enable Register
+#define AT91C_PIOD_SLEWRATE1 (AT91_CAST(AT91_REG *) 	0xFFFFF8B0) // (PIOD) PIO Slewrate Control Register
+// ========== Register definition for PIOE peripheral ========== 
+#define AT91C_PIOE_ODSR (AT91_CAST(AT91_REG *) 	0xFFFFFA38) // (PIOE) Output Data Status Register
+#define AT91C_PIOE_ABSR (AT91_CAST(AT91_REG *) 	0xFFFFFA78) // (PIOE) AB Select Status Register
+#define AT91C_PIOE_PSR  (AT91_CAST(AT91_REG *) 	0xFFFFFA08) // (PIOE) PIO Status Register
+#define AT91C_PIOE_PPUDR (AT91_CAST(AT91_REG *) 	0xFFFFFA60) // (PIOE) Pull-up Disable Register
+#define AT91C_PIOE_OER  (AT91_CAST(AT91_REG *) 	0xFFFFFA10) // (PIOE) Output Enable Register
+#define AT91C_PIOE_IFSR (AT91_CAST(AT91_REG *) 	0xFFFFFA28) // (PIOE) Input Filter Status Register
+#define AT91C_PIOE_IFER (AT91_CAST(AT91_REG *) 	0xFFFFFA20) // (PIOE) Input Filter Enable Register
+#define AT91C_PIOE_DELAY3 (AT91_CAST(AT91_REG *) 	0xFFFFFAC8) // (PIOE) PIO Delay Control Register
+#define AT91C_PIOE_ODR  (AT91_CAST(AT91_REG *) 	0xFFFFFA14) // (PIOE) Output Disable Registerr
+#define AT91C_PIOE_IDR  (AT91_CAST(AT91_REG *) 	0xFFFFFA44) // (PIOE) Interrupt Disable Register
+#define AT91C_PIOE_DELAY1 (AT91_CAST(AT91_REG *) 	0xFFFFFAC0) // (PIOE) PIO Delay Control Register
+#define AT91C_PIOE_OSR  (AT91_CAST(AT91_REG *) 	0xFFFFFA18) // (PIOE) Output Status Register
+#define AT91C_PIOE_CODR (AT91_CAST(AT91_REG *) 	0xFFFFFA34) // (PIOE) Clear Output Data Register
+#define AT91C_PIOE_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFFAFC) // (PIOE) PIO Version Register
+#define AT91C_PIOE_MDSR (AT91_CAST(AT91_REG *) 	0xFFFFFA58) // (PIOE) Multi-driver Status Register
+#define AT91C_PIOE_PDR  (AT91_CAST(AT91_REG *) 	0xFFFFFA04) // (PIOE) PIO Disable Register
+#define AT91C_PIOE_IER  (AT91_CAST(AT91_REG *) 	0xFFFFFA40) // (PIOE) Interrupt Enable Register
+#define AT91C_PIOE_OWSR (AT91_CAST(AT91_REG *) 	0xFFFFFAA8) // (PIOE) Output Write Status Register
+#define AT91C_PIOE_BSR  (AT91_CAST(AT91_REG *) 	0xFFFFFA74) // (PIOE) Select B Register
+#define AT91C_PIOE_SLEWRATE1 (AT91_CAST(AT91_REG *) 	0xFFFFFAB0) // (PIOE) PIO Slewrate Control Register
+#define AT91C_PIOE_DELAY4 (AT91_CAST(AT91_REG *) 	0xFFFFFACC) // (PIOE) PIO Delay Control Register
+#define AT91C_PIOE_PER  (AT91_CAST(AT91_REG *) 	0xFFFFFA00) // (PIOE) PIO Enable Register
+#define AT91C_PIOE_OWDR (AT91_CAST(AT91_REG *) 	0xFFFFFAA4) // (PIOE) Output Write Disable Register
+#define AT91C_PIOE_IFDR (AT91_CAST(AT91_REG *) 	0xFFFFFA24) // (PIOE) Input Filter Disable Register
+#define AT91C_PIOE_PPUSR (AT91_CAST(AT91_REG *) 	0xFFFFFA68) // (PIOE) Pull-up Status Register
+#define AT91C_PIOE_PDSR (AT91_CAST(AT91_REG *) 	0xFFFFFA3C) // (PIOE) Pin Data Status Register
+#define AT91C_PIOE_PPUER (AT91_CAST(AT91_REG *) 	0xFFFFFA64) // (PIOE) Pull-up Enable Register
+#define AT91C_PIOE_MDDR (AT91_CAST(AT91_REG *) 	0xFFFFFA54) // (PIOE) Multi-driver Disable Register
+#define AT91C_PIOE_ISR  (AT91_CAST(AT91_REG *) 	0xFFFFFA4C) // (PIOE) Interrupt Status Register
+#define AT91C_PIOE_DELAY2 (AT91_CAST(AT91_REG *) 	0xFFFFFAC4) // (PIOE) PIO Delay Control Register
+#define AT91C_PIOE_SODR (AT91_CAST(AT91_REG *) 	0xFFFFFA30) // (PIOE) Set Output Data Register
+#define AT91C_PIOE_ASR  (AT91_CAST(AT91_REG *) 	0xFFFFFA70) // (PIOE) Select A Register
+#define AT91C_PIOE_IMR  (AT91_CAST(AT91_REG *) 	0xFFFFFA48) // (PIOE) Interrupt Mask Register
+#define AT91C_PIOE_OWER (AT91_CAST(AT91_REG *) 	0xFFFFFAA0) // (PIOE) Output Write Enable Register
+#define AT91C_PIOE_MDER (AT91_CAST(AT91_REG *) 	0xFFFFFA50) // (PIOE) Multi-driver Enable Register
+// ========== Register definition for PMC peripheral ========== 
+#define AT91C_PMC_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFFFFCEC) // (PMC) 
+#define AT91C_PMC_PCER  (AT91_CAST(AT91_REG *) 	0xFFFFFC10) // (PMC) Peripheral Clock Enable Register
+#define AT91C_PMC_PCKR  (AT91_CAST(AT91_REG *) 	0xFFFFFC40) // (PMC) Programmable Clock 0 Register
+#define AT91C_PMC_MCKR  (AT91_CAST(AT91_REG *) 	0xFFFFFC30) // (PMC) Master Clock Register
+#define AT91C_PMC_PLLAR (AT91_CAST(AT91_REG *) 	0xFFFFFC28) // (PMC) PLL A Register
+#define AT91C_PMC_NAME2 (AT91_CAST(AT91_REG *) 	0xFFFFFCF4) // (PMC) 
+#define AT91C_PMC_PCDR  (AT91_CAST(AT91_REG *) 	0xFFFFFC14) // (PMC) Peripheral Clock Disable Register
+#define AT91C_PMC_SCSR  (AT91_CAST(AT91_REG *) 	0xFFFFFC08) // (PMC) System Clock Status Register
+#define AT91C_PMC_MCFR  (AT91_CAST(AT91_REG *) 	0xFFFFFC24) // (PMC) Main Clock  Frequency Register
+#define AT91C_PMC_FEATURES (AT91_CAST(AT91_REG *) 	0xFFFFFCF8) // (PMC) 
+#define AT91C_PMC_PLLICPR (AT91_CAST(AT91_REG *) 	0xFFFFFC80) // (PMC) PLL Charge Pump Current Register
+#define AT91C_PMC_IMR   (AT91_CAST(AT91_REG *) 	0xFFFFFC6C) // (PMC) Interrupt Mask Register
+#define AT91C_PMC_IER   (AT91_CAST(AT91_REG *) 	0xFFFFFC60) // (PMC) Interrupt Enable Register
+#define AT91C_PMC_UCKR  (AT91_CAST(AT91_REG *) 	0xFFFFFC1C) // (PMC) UTMI Clock Configuration Register
+#define AT91C_PMC_USB   (AT91_CAST(AT91_REG *) 	0xFFFFFC38) // (PMC) USB clock register
+#define AT91C_PMC_MOR   (AT91_CAST(AT91_REG *) 	0xFFFFFC20) // (PMC) Main Oscillator Register
+#define AT91C_PMC_IDR   (AT91_CAST(AT91_REG *) 	0xFFFFFC64) // (PMC) Interrupt Disable Register
+#define AT91C_PMC_NAME1 (AT91_CAST(AT91_REG *) 	0xFFFFFCF0) // (PMC) 
+#define AT91C_PMC_SCDR  (AT91_CAST(AT91_REG *) 	0xFFFFFC04) // (PMC) System Clock Disable Register
+#define AT91C_PMC_PCSR  (AT91_CAST(AT91_REG *) 	0xFFFFFC18) // (PMC) Peripheral Clock Status Register
+#define AT91C_PMC_SCER  (AT91_CAST(AT91_REG *) 	0xFFFFFC00) // (PMC) System Clock Enable Register
+#define AT91C_PMC_VERSION (AT91_CAST(AT91_REG *) 	0xFFFFFCFC) // (PMC) 
+#define AT91C_PMC_SR    (AT91_CAST(AT91_REG *) 	0xFFFFFC68) // (PMC) Status Register
+// ========== Register definition for CKGR peripheral ========== 
+#define AT91C_CKGR_MOR  (AT91_CAST(AT91_REG *) 	0xFFFFFC20) // (CKGR) Main Oscillator Register
+#define AT91C_CKGR_MCFR (AT91_CAST(AT91_REG *) 	0xFFFFFC24) // (CKGR) Main Clock  Frequency Register
+#define AT91C_CKGR_PLLAR (AT91_CAST(AT91_REG *) 	0xFFFFFC28) // (CKGR) PLL A Register
+#define AT91C_CKGR_UCKR (AT91_CAST(AT91_REG *) 	0xFFFFFC1C) // (CKGR) UTMI Clock Configuration Register
+// ========== Register definition for RSTC peripheral ========== 
+#define AT91C_RSTC_RCR  (AT91_CAST(AT91_REG *) 	0xFFFFFD00) // (RSTC) Reset Control Register
+#define AT91C_RSTC_VER  (AT91_CAST(AT91_REG *) 	0xFFFFFDFC) // (RSTC) Version Register
+#define AT91C_RSTC_RMR  (AT91_CAST(AT91_REG *) 	0xFFFFFD08) // (RSTC) Reset Mode Register
+#define AT91C_RSTC_RSR  (AT91_CAST(AT91_REG *) 	0xFFFFFD04) // (RSTC) Reset Status Register
+// ========== Register definition for SHDWC peripheral ========== 
+#define AT91C_SHDWC_SHSR (AT91_CAST(AT91_REG *) 	0xFFFFFD18) // (SHDWC) Shut Down Status Register
+#define AT91C_SHDWC_SHMR (AT91_CAST(AT91_REG *) 	0xFFFFFD14) // (SHDWC) Shut Down Mode Register
+#define AT91C_SHDWC_SHCR (AT91_CAST(AT91_REG *) 	0xFFFFFD10) // (SHDWC) Shut Down Control Register
+// ========== Register definition for RTTC peripheral ========== 
+#define AT91C_RTTC_RTSR (AT91_CAST(AT91_REG *) 	0xFFFFFD2C) // (RTTC) Real-time Status Register
+#define AT91C_RTTC_RTMR (AT91_CAST(AT91_REG *) 	0xFFFFFD20) // (RTTC) Real-time Mode Register
+#define AT91C_RTTC_RTVR (AT91_CAST(AT91_REG *) 	0xFFFFFD28) // (RTTC) Real-time Value Register
+#define AT91C_RTTC_RTAR (AT91_CAST(AT91_REG *) 	0xFFFFFD24) // (RTTC) Real-time Alarm Register
+// ========== Register definition for PITC peripheral ========== 
+#define AT91C_PITC_PIVR (AT91_CAST(AT91_REG *) 	0xFFFFFD38) // (PITC) Period Interval Value Register
+#define AT91C_PITC_PISR (AT91_CAST(AT91_REG *) 	0xFFFFFD34) // (PITC) Period Interval Status Register
+#define AT91C_PITC_PIIR (AT91_CAST(AT91_REG *) 	0xFFFFFD3C) // (PITC) Period Interval Image Register
+#define AT91C_PITC_PIMR (AT91_CAST(AT91_REG *) 	0xFFFFFD30) // (PITC) Period Interval Mode Register
+// ========== Register definition for WDTC peripheral ========== 
+#define AT91C_WDTC_WDCR (AT91_CAST(AT91_REG *) 	0xFFFFFD40) // (WDTC) Watchdog Control Register
+#define AT91C_WDTC_WDSR (AT91_CAST(AT91_REG *) 	0xFFFFFD48) // (WDTC) Watchdog Status Register
+#define AT91C_WDTC_WDMR (AT91_CAST(AT91_REG *) 	0xFFFFFD44) // (WDTC) Watchdog Mode Register
+// ========== Register definition for RTC peripheral ========== 
+#define AT91C_RTC_IDR   (AT91_CAST(AT91_REG *) 	0xFFFFFDD4) // (RTC) Interrupt Disable Register
+#define AT91C_RTC_SR    (AT91_CAST(AT91_REG *) 	0xFFFFFDC8) // (RTC) Status Register
+#define AT91C_RTC_MR    (AT91_CAST(AT91_REG *) 	0xFFFFFDB4) // (RTC) Mode Register
+#define AT91C_RTC_IER   (AT91_CAST(AT91_REG *) 	0xFFFFFDD0) // (RTC) Interrupt Enable Register
+#define AT91C_RTC_TIMALR (AT91_CAST(AT91_REG *) 	0xFFFFFDC0) // (RTC) Time Alarm Register
+#define AT91C_RTC_CALALR (AT91_CAST(AT91_REG *) 	0xFFFFFDC4) // (RTC) Calendar Alarm Register
+#define AT91C_RTC_CR    (AT91_CAST(AT91_REG *) 	0xFFFFFDB0) // (RTC) Control Register
+#define AT91C_RTC_TIMR  (AT91_CAST(AT91_REG *) 	0xFFFFFDB8) // (RTC) Time Register
+#define AT91C_RTC_CALR  (AT91_CAST(AT91_REG *) 	0xFFFFFDBC) // (RTC) Calendar Register
+#define AT91C_RTC_VER   (AT91_CAST(AT91_REG *) 	0xFFFFFDDC) // (RTC) Valid Entry Register
+#define AT91C_RTC_SCCR  (AT91_CAST(AT91_REG *) 	0xFFFFFDCC) // (RTC) Status Clear Command Register
+#define AT91C_RTC_IMR   (AT91_CAST(AT91_REG *) 	0xFFFFFDD8) // (RTC) Interrupt Mask Register
+// ========== Register definition for TC0 peripheral ========== 
+#define AT91C_TC0_IER   (AT91_CAST(AT91_REG *) 	0xFFF7C024) // (TC0) Interrupt Enable Register
+#define AT91C_TC0_IMR   (AT91_CAST(AT91_REG *) 	0xFFF7C02C) // (TC0) Interrupt Mask Register
+#define AT91C_TC0_CCR   (AT91_CAST(AT91_REG *) 	0xFFF7C000) // (TC0) Channel Control Register
+#define AT91C_TC0_RB    (AT91_CAST(AT91_REG *) 	0xFFF7C018) // (TC0) Register B
+#define AT91C_TC0_CV    (AT91_CAST(AT91_REG *) 	0xFFF7C010) // (TC0) Counter Value
+#define AT91C_TC0_SR    (AT91_CAST(AT91_REG *) 	0xFFF7C020) // (TC0) Status Register
+#define AT91C_TC0_CMR   (AT91_CAST(AT91_REG *) 	0xFFF7C004) // (TC0) Channel Mode Register (Capture Mode / Waveform Mode)
+#define AT91C_TC0_RA    (AT91_CAST(AT91_REG *) 	0xFFF7C014) // (TC0) Register A
+#define AT91C_TC0_RC    (AT91_CAST(AT91_REG *) 	0xFFF7C01C) // (TC0) Register C
+#define AT91C_TC0_IDR   (AT91_CAST(AT91_REG *) 	0xFFF7C028) // (TC0) Interrupt Disable Register
+// ========== Register definition for TC1 peripheral ========== 
+#define AT91C_TC1_IER   (AT91_CAST(AT91_REG *) 	0xFFF7C064) // (TC1) Interrupt Enable Register
+#define AT91C_TC1_SR    (AT91_CAST(AT91_REG *) 	0xFFF7C060) // (TC1) Status Register
+#define AT91C_TC1_RC    (AT91_CAST(AT91_REG *) 	0xFFF7C05C) // (TC1) Register C
+#define AT91C_TC1_CV    (AT91_CAST(AT91_REG *) 	0xFFF7C050) // (TC1) Counter Value
+#define AT91C_TC1_RA    (AT91_CAST(AT91_REG *) 	0xFFF7C054) // (TC1) Register A
+#define AT91C_TC1_CMR   (AT91_CAST(AT91_REG *) 	0xFFF7C044) // (TC1) Channel Mode Register (Capture Mode / Waveform Mode)
+#define AT91C_TC1_IDR   (AT91_CAST(AT91_REG *) 	0xFFF7C068) // (TC1) Interrupt Disable Register
+#define AT91C_TC1_RB    (AT91_CAST(AT91_REG *) 	0xFFF7C058) // (TC1) Register B
+#define AT91C_TC1_IMR   (AT91_CAST(AT91_REG *) 	0xFFF7C06C) // (TC1) Interrupt Mask Register
+#define AT91C_TC1_CCR   (AT91_CAST(AT91_REG *) 	0xFFF7C040) // (TC1) Channel Control Register
+// ========== Register definition for TC2 peripheral ========== 
+#define AT91C_TC2_SR    (AT91_CAST(AT91_REG *) 	0xFFF7C0A0) // (TC2) Status Register
+#define AT91C_TC2_IMR   (AT91_CAST(AT91_REG *) 	0xFFF7C0AC) // (TC2) Interrupt Mask Register
+#define AT91C_TC2_IER   (AT91_CAST(AT91_REG *) 	0xFFF7C0A4) // (TC2) Interrupt Enable Register
+#define AT91C_TC2_CV    (AT91_CAST(AT91_REG *) 	0xFFF7C090) // (TC2) Counter Value
+#define AT91C_TC2_RB    (AT91_CAST(AT91_REG *) 	0xFFF7C098) // (TC2) Register B
+#define AT91C_TC2_CCR   (AT91_CAST(AT91_REG *) 	0xFFF7C080) // (TC2) Channel Control Register
+#define AT91C_TC2_CMR   (AT91_CAST(AT91_REG *) 	0xFFF7C084) // (TC2) Channel Mode Register (Capture Mode / Waveform Mode)
+#define AT91C_TC2_RA    (AT91_CAST(AT91_REG *) 	0xFFF7C094) // (TC2) Register A
+#define AT91C_TC2_IDR   (AT91_CAST(AT91_REG *) 	0xFFF7C0A8) // (TC2) Interrupt Disable Register
+#define AT91C_TC2_RC    (AT91_CAST(AT91_REG *) 	0xFFF7C09C) // (TC2) Register C
+// ========== Register definition for TC3 peripheral ========== 
+#define AT91C_TC3_SR    (AT91_CAST(AT91_REG *) 	0xFFFD4020) // (TC3) Status Register
+#define AT91C_TC3_RC    (AT91_CAST(AT91_REG *) 	0xFFFD401C) // (TC3) Register C
+#define AT91C_TC3_IER   (AT91_CAST(AT91_REG *) 	0xFFFD4024) // (TC3) Interrupt Enable Register
+#define AT91C_TC3_CV    (AT91_CAST(AT91_REG *) 	0xFFFD4010) // (TC3) Counter Value
+#define AT91C_TC3_IDR   (AT91_CAST(AT91_REG *) 	0xFFFD4028) // (TC3) Interrupt Disable Register
+#define AT91C_TC3_IMR   (AT91_CAST(AT91_REG *) 	0xFFFD402C) // (TC3) Interrupt Mask Register
+#define AT91C_TC3_CMR   (AT91_CAST(AT91_REG *) 	0xFFFD4004) // (TC3) Channel Mode Register (Capture Mode / Waveform Mode)
+#define AT91C_TC3_RB    (AT91_CAST(AT91_REG *) 	0xFFFD4018) // (TC3) Register B
+#define AT91C_TC3_CCR   (AT91_CAST(AT91_REG *) 	0xFFFD4000) // (TC3) Channel Control Register
+#define AT91C_TC3_RA    (AT91_CAST(AT91_REG *) 	0xFFFD4014) // (TC3) Register A
+// ========== Register definition for TC4 peripheral ========== 
+#define AT91C_TC4_CV    (AT91_CAST(AT91_REG *) 	0xFFFD4050) // (TC4) Counter Value
+#define AT91C_TC4_RA    (AT91_CAST(AT91_REG *) 	0xFFFD4054) // (TC4) Register A
+#define AT91C_TC4_IDR   (AT91_CAST(AT91_REG *) 	0xFFFD4068) // (TC4) Interrupt Disable Register
+#define AT91C_TC4_SR    (AT91_CAST(AT91_REG *) 	0xFFFD4060) // (TC4) Status Register
+#define AT91C_TC4_CMR   (AT91_CAST(AT91_REG *) 	0xFFFD4044) // (TC4) Channel Mode Register (Capture Mode / Waveform Mode)
+#define AT91C_TC4_CCR   (AT91_CAST(AT91_REG *) 	0xFFFD4040) // (TC4) Channel Control Register
+#define AT91C_TC4_RB    (AT91_CAST(AT91_REG *) 	0xFFFD4058) // (TC4) Register B
+#define AT91C_TC4_RC    (AT91_CAST(AT91_REG *) 	0xFFFD405C) // (TC4) Register C
+#define AT91C_TC4_IER   (AT91_CAST(AT91_REG *) 	0xFFFD4064) // (TC4) Interrupt Enable Register
+#define AT91C_TC4_IMR   (AT91_CAST(AT91_REG *) 	0xFFFD406C) // (TC4) Interrupt Mask Register
+// ========== Register definition for TC5 peripheral ========== 
+#define AT91C_TC5_IER   (AT91_CAST(AT91_REG *) 	0xFFFD40A4) // (TC5) Interrupt Enable Register
+#define AT91C_TC5_IDR   (AT91_CAST(AT91_REG *) 	0xFFFD40A8) // (TC5) Interrupt Disable Register
+#define AT91C_TC5_RA    (AT91_CAST(AT91_REG *) 	0xFFFD4094) // (TC5) Register A
+#define AT91C_TC5_RB    (AT91_CAST(AT91_REG *) 	0xFFFD4098) // (TC5) Register B
+#define AT91C_TC5_CCR   (AT91_CAST(AT91_REG *) 	0xFFFD4080) // (TC5) Channel Control Register
+#define AT91C_TC5_SR    (AT91_CAST(AT91_REG *) 	0xFFFD40A0) // (TC5) Status Register
+#define AT91C_TC5_CV    (AT91_CAST(AT91_REG *) 	0xFFFD4090) // (TC5) Counter Value
+#define AT91C_TC5_RC    (AT91_CAST(AT91_REG *) 	0xFFFD409C) // (TC5) Register C
+#define AT91C_TC5_IMR   (AT91_CAST(AT91_REG *) 	0xFFFD40AC) // (TC5) Interrupt Mask Register
+#define AT91C_TC5_CMR   (AT91_CAST(AT91_REG *) 	0xFFFD4084) // (TC5) Channel Mode Register (Capture Mode / Waveform Mode)
+// ========== Register definition for TCB0 peripheral ========== 
+#define AT91C_TCB0_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF7C0F0) // (TCB0) TC IPNAME1 REGISTER 
+#define AT91C_TCB0_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF7C0F4) // (TCB0) TC IPNAME2 REGISTER 
+#define AT91C_TCB0_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF7C0F8) // (TCB0) TC FEATURES REGISTER 
+#define AT91C_TCB0_BCR  (AT91_CAST(AT91_REG *) 	0xFFF7C0C0) // (TCB0) TC Block Control Register
+#define AT91C_TCB0_VER  (AT91_CAST(AT91_REG *) 	0xFFF7C0FC) // (TCB0)  Version Register
+#define AT91C_TCB0_BMR  (AT91_CAST(AT91_REG *) 	0xFFF7C0C4) // (TCB0) TC Block Mode Register
+#define AT91C_TCB0_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF7C0EC) // (TCB0) TC ADDRSIZE REGISTER 
+// ========== Register definition for TCB1 peripheral ========== 
+#define AT91C_TCB1_VER  (AT91_CAST(AT91_REG *) 	0xFFFD40FC) // (TCB1)  Version Register
+#define AT91C_TCB1_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFFD40F4) // (TCB1) TC IPNAME2 REGISTER 
+#define AT91C_TCB1_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFFD40EC) // (TCB1) TC ADDRSIZE REGISTER 
+#define AT91C_TCB1_BMR  (AT91_CAST(AT91_REG *) 	0xFFFD40C4) // (TCB1) TC Block Mode Register
+#define AT91C_TCB1_FEATURES (AT91_CAST(AT91_REG *) 	0xFFFD40F8) // (TCB1) TC FEATURES REGISTER 
+#define AT91C_TCB1_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFFD40F0) // (TCB1) TC IPNAME1 REGISTER 
+#define AT91C_TCB1_BCR  (AT91_CAST(AT91_REG *) 	0xFFFD40C0) // (TCB1) TC Block Control Register
+// ========== Register definition for MCI0 peripheral ========== 
+#define AT91C_MCI0_IMR  (AT91_CAST(AT91_REG *) 	0xFFF8004C) // (MCI0) MCI Interrupt Mask Register
+#define AT91C_MCI0_MR   (AT91_CAST(AT91_REG *) 	0xFFF80004) // (MCI0) MCI Mode Register
+#define AT91C_MCI0_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF800EC) // (MCI0) MCI ADDRSIZE REGISTER 
+#define AT91C_MCI0_CR   (AT91_CAST(AT91_REG *) 	0xFFF80000) // (MCI0) MCI Control Register
+#define AT91C_MCI0_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF800F4) // (MCI0) MCI IPNAME2 REGISTER 
+#define AT91C_MCI0_IER  (AT91_CAST(AT91_REG *) 	0xFFF80044) // (MCI0) MCI Interrupt Enable Register
+#define AT91C_MCI0_FIFO (AT91_CAST(AT91_REG *) 	0xFFF80200) // (MCI0) MCI FIFO Aperture Register
+#define AT91C_MCI0_DTOR (AT91_CAST(AT91_REG *) 	0xFFF80008) // (MCI0) MCI Data Timeout Register
+#define AT91C_MCI0_SDCR (AT91_CAST(AT91_REG *) 	0xFFF8000C) // (MCI0) MCI SD/SDIO Card Register
+#define AT91C_MCI0_BLKR (AT91_CAST(AT91_REG *) 	0xFFF80018) // (MCI0) MCI Block Register
+#define AT91C_MCI0_VER  (AT91_CAST(AT91_REG *) 	0xFFF800FC) // (MCI0) MCI VERSION REGISTER 
+#define AT91C_MCI0_WPSR (AT91_CAST(AT91_REG *) 	0xFFF800E8) // (MCI0) MCI Write Protection Status Register
+#define AT91C_MCI0_CMDR (AT91_CAST(AT91_REG *) 	0xFFF80014) // (MCI0) MCI Command Register
+#define AT91C_MCI0_CSTOR (AT91_CAST(AT91_REG *) 	0xFFF8001C) // (MCI0) MCI Completion Signal Timeout Register
+#define AT91C_MCI0_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF800F0) // (MCI0) MCI IPNAME1 REGISTER 
+#define AT91C_MCI0_DMA  (AT91_CAST(AT91_REG *) 	0xFFF80050) // (MCI0) MCI DMA Configuration Register
+#define AT91C_MCI0_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF800F8) // (MCI0) MCI FEATURES REGISTER 
+#define AT91C_MCI0_RDR  (AT91_CAST(AT91_REG *) 	0xFFF80030) // (MCI0) MCI Receive Data Register
+#define AT91C_MCI0_SR   (AT91_CAST(AT91_REG *) 	0xFFF80040) // (MCI0) MCI Status Register
+#define AT91C_MCI0_TDR  (AT91_CAST(AT91_REG *) 	0xFFF80034) // (MCI0) MCI Transmit Data Register
+#define AT91C_MCI0_CFG  (AT91_CAST(AT91_REG *) 	0xFFF80054) // (MCI0) MCI Configuration Register
+#define AT91C_MCI0_ARGR (AT91_CAST(AT91_REG *) 	0xFFF80010) // (MCI0) MCI Argument Register
+#define AT91C_MCI0_RSPR (AT91_CAST(AT91_REG *) 	0xFFF80020) // (MCI0) MCI Response Register
+#define AT91C_MCI0_WPCR (AT91_CAST(AT91_REG *) 	0xFFF800E4) // (MCI0) MCI Write Protection Control Register
+#define AT91C_MCI0_IDR  (AT91_CAST(AT91_REG *) 	0xFFF80048) // (MCI0) MCI Interrupt Disable Register
+// ========== Register definition for MCI1 peripheral ========== 
+#define AT91C_MCI1_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFFD00F0) // (MCI1) MCI IPNAME1 REGISTER 
+#define AT91C_MCI1_IDR  (AT91_CAST(AT91_REG *) 	0xFFFD0048) // (MCI1) MCI Interrupt Disable Register
+#define AT91C_MCI1_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFFD00F4) // (MCI1) MCI IPNAME2 REGISTER 
+#define AT91C_MCI1_MR   (AT91_CAST(AT91_REG *) 	0xFFFD0004) // (MCI1) MCI Mode Register
+#define AT91C_MCI1_SR   (AT91_CAST(AT91_REG *) 	0xFFFD0040) // (MCI1) MCI Status Register
+#define AT91C_MCI1_DTOR (AT91_CAST(AT91_REG *) 	0xFFFD0008) // (MCI1) MCI Data Timeout Register
+#define AT91C_MCI1_WPCR (AT91_CAST(AT91_REG *) 	0xFFFD00E4) // (MCI1) MCI Write Protection Control Register
+#define AT91C_MCI1_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFFD00EC) // (MCI1) MCI ADDRSIZE REGISTER 
+#define AT91C_MCI1_ARGR (AT91_CAST(AT91_REG *) 	0xFFFD0010) // (MCI1) MCI Argument Register
+#define AT91C_MCI1_FIFO (AT91_CAST(AT91_REG *) 	0xFFFD0200) // (MCI1) MCI FIFO Aperture Register
+#define AT91C_MCI1_IER  (AT91_CAST(AT91_REG *) 	0xFFFD0044) // (MCI1) MCI Interrupt Enable Register
+#define AT91C_MCI1_SDCR (AT91_CAST(AT91_REG *) 	0xFFFD000C) // (MCI1) MCI SD/SDIO Card Register
+#define AT91C_MCI1_FEATURES (AT91_CAST(AT91_REG *) 	0xFFFD00F8) // (MCI1) MCI FEATURES REGISTER 
+#define AT91C_MCI1_CR   (AT91_CAST(AT91_REG *) 	0xFFFD0000) // (MCI1) MCI Control Register
+#define AT91C_MCI1_CSTOR (AT91_CAST(AT91_REG *) 	0xFFFD001C) // (MCI1) MCI Completion Signal Timeout Register
+#define AT91C_MCI1_RSPR (AT91_CAST(AT91_REG *) 	0xFFFD0020) // (MCI1) MCI Response Register
+#define AT91C_MCI1_IMR  (AT91_CAST(AT91_REG *) 	0xFFFD004C) // (MCI1) MCI Interrupt Mask Register
+#define AT91C_MCI1_DMA  (AT91_CAST(AT91_REG *) 	0xFFFD0050) // (MCI1) MCI DMA Configuration Register
+#define AT91C_MCI1_BLKR (AT91_CAST(AT91_REG *) 	0xFFFD0018) // (MCI1) MCI Block Register
+#define AT91C_MCI1_RDR  (AT91_CAST(AT91_REG *) 	0xFFFD0030) // (MCI1) MCI Receive Data Register
+#define AT91C_MCI1_CFG  (AT91_CAST(AT91_REG *) 	0xFFFD0054) // (MCI1) MCI Configuration Register
+#define AT91C_MCI1_WPSR (AT91_CAST(AT91_REG *) 	0xFFFD00E8) // (MCI1) MCI Write Protection Status Register
+#define AT91C_MCI1_CMDR (AT91_CAST(AT91_REG *) 	0xFFFD0014) // (MCI1) MCI Command Register
+#define AT91C_MCI1_TDR  (AT91_CAST(AT91_REG *) 	0xFFFD0034) // (MCI1) MCI Transmit Data Register
+#define AT91C_MCI1_VER  (AT91_CAST(AT91_REG *) 	0xFFFD00FC) // (MCI1) MCI VERSION REGISTER 
+// ========== Register definition for TWI0 peripheral ========== 
+#define AT91C_TWI0_RHR  (AT91_CAST(AT91_REG *) 	0xFFF84030) // (TWI0) Receive Holding Register
+#define AT91C_TWI0_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF840EC) // (TWI0) TWI ADDRSIZE REGISTER 
+#define AT91C_TWI0_SMR  (AT91_CAST(AT91_REG *) 	0xFFF84008) // (TWI0) Slave Mode Register
+#define AT91C_TWI0_IDR  (AT91_CAST(AT91_REG *) 	0xFFF84028) // (TWI0) Interrupt Disable Register
+#define AT91C_TWI0_CWGR (AT91_CAST(AT91_REG *) 	0xFFF84010) // (TWI0) Clock Waveform Generator Register
+#define AT91C_TWI0_IER  (AT91_CAST(AT91_REG *) 	0xFFF84024) // (TWI0) Interrupt Enable Register
+#define AT91C_TWI0_THR  (AT91_CAST(AT91_REG *) 	0xFFF84034) // (TWI0) Transmit Holding Register
+#define AT91C_TWI0_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF840F4) // (TWI0) TWI IPNAME2 REGISTER 
+#define AT91C_TWI0_CR   (AT91_CAST(AT91_REG *) 	0xFFF84000) // (TWI0) Control Register
+#define AT91C_TWI0_MMR  (AT91_CAST(AT91_REG *) 	0xFFF84004) // (TWI0) Master Mode Register
+#define AT91C_TWI0_SR   (AT91_CAST(AT91_REG *) 	0xFFF84020) // (TWI0) Status Register
+#define AT91C_TWI0_IMR  (AT91_CAST(AT91_REG *) 	0xFFF8402C) // (TWI0) Interrupt Mask Register
+#define AT91C_TWI0_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF840F8) // (TWI0) TWI FEATURES REGISTER 
+#define AT91C_TWI0_IADR (AT91_CAST(AT91_REG *) 	0xFFF8400C) // (TWI0) Internal Address Register
+#define AT91C_TWI0_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF840F0) // (TWI0) TWI IPNAME1 REGISTER 
+#define AT91C_TWI0_VER  (AT91_CAST(AT91_REG *) 	0xFFF840FC) // (TWI0) Version Register
+// ========== Register definition for TWI1 peripheral ========== 
+#define AT91C_TWI1_VER  (AT91_CAST(AT91_REG *) 	0xFFF880FC) // (TWI1) Version Register
+#define AT91C_TWI1_IMR  (AT91_CAST(AT91_REG *) 	0xFFF8802C) // (TWI1) Interrupt Mask Register
+#define AT91C_TWI1_THR  (AT91_CAST(AT91_REG *) 	0xFFF88034) // (TWI1) Transmit Holding Register
+#define AT91C_TWI1_IER  (AT91_CAST(AT91_REG *) 	0xFFF88024) // (TWI1) Interrupt Enable Register
+#define AT91C_TWI1_MMR  (AT91_CAST(AT91_REG *) 	0xFFF88004) // (TWI1) Master Mode Register
+#define AT91C_TWI1_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF880F0) // (TWI1) TWI IPNAME1 REGISTER 
+#define AT91C_TWI1_CR   (AT91_CAST(AT91_REG *) 	0xFFF88000) // (TWI1) Control Register
+#define AT91C_TWI1_SR   (AT91_CAST(AT91_REG *) 	0xFFF88020) // (TWI1) Status Register
+#define AT91C_TWI1_CWGR (AT91_CAST(AT91_REG *) 	0xFFF88010) // (TWI1) Clock Waveform Generator Register
+#define AT91C_TWI1_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF880F4) // (TWI1) TWI IPNAME2 REGISTER 
+#define AT91C_TWI1_IDR  (AT91_CAST(AT91_REG *) 	0xFFF88028) // (TWI1) Interrupt Disable Register
+#define AT91C_TWI1_RHR  (AT91_CAST(AT91_REG *) 	0xFFF88030) // (TWI1) Receive Holding Register
+#define AT91C_TWI1_IADR (AT91_CAST(AT91_REG *) 	0xFFF8800C) // (TWI1) Internal Address Register
+#define AT91C_TWI1_SMR  (AT91_CAST(AT91_REG *) 	0xFFF88008) // (TWI1) Slave Mode Register
+#define AT91C_TWI1_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF880F8) // (TWI1) TWI FEATURES REGISTER 
+#define AT91C_TWI1_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF880EC) // (TWI1) TWI ADDRSIZE REGISTER 
+// ========== Register definition for PDC_US0 peripheral ========== 
+#define AT91C_US0_TNPR  (AT91_CAST(AT91_REG *) 	0xFFF8C118) // (PDC_US0) Transmit Next Pointer Register
+#define AT91C_US0_PTSR  (AT91_CAST(AT91_REG *) 	0xFFF8C124) // (PDC_US0) PDC Transfer Status Register
+#define AT91C_US0_PTCR  (AT91_CAST(AT91_REG *) 	0xFFF8C120) // (PDC_US0) PDC Transfer Control Register
+#define AT91C_US0_RNCR  (AT91_CAST(AT91_REG *) 	0xFFF8C114) // (PDC_US0) Receive Next Counter Register
+#define AT91C_US0_RCR   (AT91_CAST(AT91_REG *) 	0xFFF8C104) // (PDC_US0) Receive Counter Register
+#define AT91C_US0_TNCR  (AT91_CAST(AT91_REG *) 	0xFFF8C11C) // (PDC_US0) Transmit Next Counter Register
+#define AT91C_US0_TCR   (AT91_CAST(AT91_REG *) 	0xFFF8C10C) // (PDC_US0) Transmit Counter Register
+#define AT91C_US0_RNPR  (AT91_CAST(AT91_REG *) 	0xFFF8C110) // (PDC_US0) Receive Next Pointer Register
+#define AT91C_US0_RPR   (AT91_CAST(AT91_REG *) 	0xFFF8C100) // (PDC_US0) Receive Pointer Register
+#define AT91C_US0_TPR   (AT91_CAST(AT91_REG *) 	0xFFF8C108) // (PDC_US0) Transmit Pointer Register
+// ========== Register definition for US0 peripheral ========== 
+#define AT91C_US0_MAN   (AT91_CAST(AT91_REG *) 	0xFFF8C050) // (US0) Manchester Encoder Decoder Register
+#define AT91C_US0_MR    (AT91_CAST(AT91_REG *) 	0xFFF8C004) // (US0) Mode Register
+#define AT91C_US0_RHR   (AT91_CAST(AT91_REG *) 	0xFFF8C018) // (US0) Receiver Holding Register
+#define AT91C_US0_CSR   (AT91_CAST(AT91_REG *) 	0xFFF8C014) // (US0) Channel Status Register
+#define AT91C_US0_CR    (AT91_CAST(AT91_REG *) 	0xFFF8C000) // (US0) Control Register
+#define AT91C_US0_VER   (AT91_CAST(AT91_REG *) 	0xFFF8C0FC) // (US0) VERSION Register
+#define AT91C_US0_IER   (AT91_CAST(AT91_REG *) 	0xFFF8C008) // (US0) Interrupt Enable Register
+#define AT91C_US0_BRGR  (AT91_CAST(AT91_REG *) 	0xFFF8C020) // (US0) Baud Rate Generator Register
+#define AT91C_US0_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF8C0F8) // (US0) US FEATURES REGISTER 
+#define AT91C_US0_RTOR  (AT91_CAST(AT91_REG *) 	0xFFF8C024) // (US0) Receiver Time-out Register
+#define AT91C_US0_THR   (AT91_CAST(AT91_REG *) 	0xFFF8C01C) // (US0) Transmitter Holding Register
+#define AT91C_US0_NER   (AT91_CAST(AT91_REG *) 	0xFFF8C044) // (US0) Nb Errors Register
+#define AT91C_US0_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF8C0F0) // (US0) US IPNAME1 REGISTER 
+#define AT91C_US0_IMR   (AT91_CAST(AT91_REG *) 	0xFFF8C010) // (US0) Interrupt Mask Register
+#define AT91C_US0_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF8C0EC) // (US0) US ADDRSIZE REGISTER 
+#define AT91C_US0_IDR   (AT91_CAST(AT91_REG *) 	0xFFF8C00C) // (US0) Interrupt Disable Register
+#define AT91C_US0_FIDI  (AT91_CAST(AT91_REG *) 	0xFFF8C040) // (US0) FI_DI_Ratio Register
+#define AT91C_US0_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF8C0F4) // (US0) US IPNAME2 REGISTER 
+#define AT91C_US0_TTGR  (AT91_CAST(AT91_REG *) 	0xFFF8C028) // (US0) Transmitter Time-guard Register
+#define AT91C_US0_IF    (AT91_CAST(AT91_REG *) 	0xFFF8C04C) // (US0) IRDA_FILTER Register
+// ========== Register definition for PDC_US1 peripheral ========== 
+#define AT91C_US1_PTCR  (AT91_CAST(AT91_REG *) 	0xFFF90120) // (PDC_US1) PDC Transfer Control Register
+#define AT91C_US1_TNCR  (AT91_CAST(AT91_REG *) 	0xFFF9011C) // (PDC_US1) Transmit Next Counter Register
+#define AT91C_US1_RCR   (AT91_CAST(AT91_REG *) 	0xFFF90104) // (PDC_US1) Receive Counter Register
+#define AT91C_US1_RPR   (AT91_CAST(AT91_REG *) 	0xFFF90100) // (PDC_US1) Receive Pointer Register
+#define AT91C_US1_TPR   (AT91_CAST(AT91_REG *) 	0xFFF90108) // (PDC_US1) Transmit Pointer Register
+#define AT91C_US1_TCR   (AT91_CAST(AT91_REG *) 	0xFFF9010C) // (PDC_US1) Transmit Counter Register
+#define AT91C_US1_RNPR  (AT91_CAST(AT91_REG *) 	0xFFF90110) // (PDC_US1) Receive Next Pointer Register
+#define AT91C_US1_TNPR  (AT91_CAST(AT91_REG *) 	0xFFF90118) // (PDC_US1) Transmit Next Pointer Register
+#define AT91C_US1_RNCR  (AT91_CAST(AT91_REG *) 	0xFFF90114) // (PDC_US1) Receive Next Counter Register
+#define AT91C_US1_PTSR  (AT91_CAST(AT91_REG *) 	0xFFF90124) // (PDC_US1) PDC Transfer Status Register
+// ========== Register definition for US1 peripheral ========== 
+#define AT91C_US1_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF900F8) // (US1) US FEATURES REGISTER 
+#define AT91C_US1_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF900EC) // (US1) US ADDRSIZE REGISTER 
+#define AT91C_US1_NER   (AT91_CAST(AT91_REG *) 	0xFFF90044) // (US1) Nb Errors Register
+#define AT91C_US1_RHR   (AT91_CAST(AT91_REG *) 	0xFFF90018) // (US1) Receiver Holding Register
+#define AT91C_US1_IF    (AT91_CAST(AT91_REG *) 	0xFFF9004C) // (US1) IRDA_FILTER Register
+#define AT91C_US1_CR    (AT91_CAST(AT91_REG *) 	0xFFF90000) // (US1) Control Register
+#define AT91C_US1_TTGR  (AT91_CAST(AT91_REG *) 	0xFFF90028) // (US1) Transmitter Time-guard Register
+#define AT91C_US1_MR    (AT91_CAST(AT91_REG *) 	0xFFF90004) // (US1) Mode Register
+#define AT91C_US1_FIDI  (AT91_CAST(AT91_REG *) 	0xFFF90040) // (US1) FI_DI_Ratio Register
+#define AT91C_US1_RTOR  (AT91_CAST(AT91_REG *) 	0xFFF90024) // (US1) Receiver Time-out Register
+#define AT91C_US1_IER   (AT91_CAST(AT91_REG *) 	0xFFF90008) // (US1) Interrupt Enable Register
+#define AT91C_US1_MAN   (AT91_CAST(AT91_REG *) 	0xFFF90050) // (US1) Manchester Encoder Decoder Register
+#define AT91C_US1_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF900F4) // (US1) US IPNAME2 REGISTER 
+#define AT91C_US1_IMR   (AT91_CAST(AT91_REG *) 	0xFFF90010) // (US1) Interrupt Mask Register
+#define AT91C_US1_IDR   (AT91_CAST(AT91_REG *) 	0xFFF9000C) // (US1) Interrupt Disable Register
+#define AT91C_US1_CSR   (AT91_CAST(AT91_REG *) 	0xFFF90014) // (US1) Channel Status Register
+#define AT91C_US1_BRGR  (AT91_CAST(AT91_REG *) 	0xFFF90020) // (US1) Baud Rate Generator Register
+#define AT91C_US1_THR   (AT91_CAST(AT91_REG *) 	0xFFF9001C) // (US1) Transmitter Holding Register
+#define AT91C_US1_VER   (AT91_CAST(AT91_REG *) 	0xFFF900FC) // (US1) VERSION Register
+#define AT91C_US1_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF900F0) // (US1) US IPNAME1 REGISTER 
+// ========== Register definition for PDC_US2 peripheral ========== 
+#define AT91C_US2_RNCR  (AT91_CAST(AT91_REG *) 	0xFFF94114) // (PDC_US2) Receive Next Counter Register
+#define AT91C_US2_PTCR  (AT91_CAST(AT91_REG *) 	0xFFF94120) // (PDC_US2) PDC Transfer Control Register
+#define AT91C_US2_TNPR  (AT91_CAST(AT91_REG *) 	0xFFF94118) // (PDC_US2) Transmit Next Pointer Register
+#define AT91C_US2_TNCR  (AT91_CAST(AT91_REG *) 	0xFFF9411C) // (PDC_US2) Transmit Next Counter Register
+#define AT91C_US2_TPR   (AT91_CAST(AT91_REG *) 	0xFFF94108) // (PDC_US2) Transmit Pointer Register
+#define AT91C_US2_RCR   (AT91_CAST(AT91_REG *) 	0xFFF94104) // (PDC_US2) Receive Counter Register
+#define AT91C_US2_PTSR  (AT91_CAST(AT91_REG *) 	0xFFF94124) // (PDC_US2) PDC Transfer Status Register
+#define AT91C_US2_TCR   (AT91_CAST(AT91_REG *) 	0xFFF9410C) // (PDC_US2) Transmit Counter Register
+#define AT91C_US2_RPR   (AT91_CAST(AT91_REG *) 	0xFFF94100) // (PDC_US2) Receive Pointer Register
+#define AT91C_US2_RNPR  (AT91_CAST(AT91_REG *) 	0xFFF94110) // (PDC_US2) Receive Next Pointer Register
+// ========== Register definition for US2 peripheral ========== 
+#define AT91C_US2_TTGR  (AT91_CAST(AT91_REG *) 	0xFFF94028) // (US2) Transmitter Time-guard Register
+#define AT91C_US2_IER   (AT91_CAST(AT91_REG *) 	0xFFF94008) // (US2) Interrupt Enable Register
+#define AT91C_US2_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF940EC) // (US2) US ADDRSIZE REGISTER 
+#define AT91C_US2_NER   (AT91_CAST(AT91_REG *) 	0xFFF94044) // (US2) Nb Errors Register
+#define AT91C_US2_CR    (AT91_CAST(AT91_REG *) 	0xFFF94000) // (US2) Control Register
+#define AT91C_US2_IDR   (AT91_CAST(AT91_REG *) 	0xFFF9400C) // (US2) Interrupt Disable Register
+#define AT91C_US2_VER   (AT91_CAST(AT91_REG *) 	0xFFF940FC) // (US2) VERSION Register
+#define AT91C_US2_THR   (AT91_CAST(AT91_REG *) 	0xFFF9401C) // (US2) Transmitter Holding Register
+#define AT91C_US2_BRGR  (AT91_CAST(AT91_REG *) 	0xFFF94020) // (US2) Baud Rate Generator Register
+#define AT91C_US2_CSR   (AT91_CAST(AT91_REG *) 	0xFFF94014) // (US2) Channel Status Register
+#define AT91C_US2_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF940F4) // (US2) US IPNAME2 REGISTER 
+#define AT91C_US2_IMR   (AT91_CAST(AT91_REG *) 	0xFFF94010) // (US2) Interrupt Mask Register
+#define AT91C_US2_RHR   (AT91_CAST(AT91_REG *) 	0xFFF94018) // (US2) Receiver Holding Register
+#define AT91C_US2_MR    (AT91_CAST(AT91_REG *) 	0xFFF94004) // (US2) Mode Register
+#define AT91C_US2_FIDI  (AT91_CAST(AT91_REG *) 	0xFFF94040) // (US2) FI_DI_Ratio Register
+#define AT91C_US2_MAN   (AT91_CAST(AT91_REG *) 	0xFFF94050) // (US2) Manchester Encoder Decoder Register
+#define AT91C_US2_IF    (AT91_CAST(AT91_REG *) 	0xFFF9404C) // (US2) IRDA_FILTER Register
+#define AT91C_US2_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF940F8) // (US2) US FEATURES REGISTER 
+#define AT91C_US2_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF940F0) // (US2) US IPNAME1 REGISTER 
+#define AT91C_US2_RTOR  (AT91_CAST(AT91_REG *) 	0xFFF94024) // (US2) Receiver Time-out Register
+// ========== Register definition for PDC_US3 peripheral ========== 
+#define AT91C_US3_PTSR  (AT91_CAST(AT91_REG *) 	0xFFF98124) // (PDC_US3) PDC Transfer Status Register
+#define AT91C_US3_TCR   (AT91_CAST(AT91_REG *) 	0xFFF9810C) // (PDC_US3) Transmit Counter Register
+#define AT91C_US3_RNPR  (AT91_CAST(AT91_REG *) 	0xFFF98110) // (PDC_US3) Receive Next Pointer Register
+#define AT91C_US3_RNCR  (AT91_CAST(AT91_REG *) 	0xFFF98114) // (PDC_US3) Receive Next Counter Register
+#define AT91C_US3_TNPR  (AT91_CAST(AT91_REG *) 	0xFFF98118) // (PDC_US3) Transmit Next Pointer Register
+#define AT91C_US3_RPR   (AT91_CAST(AT91_REG *) 	0xFFF98100) // (PDC_US3) Receive Pointer Register
+#define AT91C_US3_TPR   (AT91_CAST(AT91_REG *) 	0xFFF98108) // (PDC_US3) Transmit Pointer Register
+#define AT91C_US3_RCR   (AT91_CAST(AT91_REG *) 	0xFFF98104) // (PDC_US3) Receive Counter Register
+#define AT91C_US3_TNCR  (AT91_CAST(AT91_REG *) 	0xFFF9811C) // (PDC_US3) Transmit Next Counter Register
+#define AT91C_US3_PTCR  (AT91_CAST(AT91_REG *) 	0xFFF98120) // (PDC_US3) PDC Transfer Control Register
+// ========== Register definition for US3 peripheral ========== 
+#define AT91C_US3_VER   (AT91_CAST(AT91_REG *) 	0xFFF980FC) // (US3) VERSION Register
+#define AT91C_US3_BRGR  (AT91_CAST(AT91_REG *) 	0xFFF98020) // (US3) Baud Rate Generator Register
+#define AT91C_US3_TTGR  (AT91_CAST(AT91_REG *) 	0xFFF98028) // (US3) Transmitter Time-guard Register
+#define AT91C_US3_RTOR  (AT91_CAST(AT91_REG *) 	0xFFF98024) // (US3) Receiver Time-out Register
+#define AT91C_US3_MAN   (AT91_CAST(AT91_REG *) 	0xFFF98050) // (US3) Manchester Encoder Decoder Register
+#define AT91C_US3_NER   (AT91_CAST(AT91_REG *) 	0xFFF98044) // (US3) Nb Errors Register
+#define AT91C_US3_CR    (AT91_CAST(AT91_REG *) 	0xFFF98000) // (US3) Control Register
+#define AT91C_US3_IDR   (AT91_CAST(AT91_REG *) 	0xFFF9800C) // (US3) Interrupt Disable Register
+#define AT91C_US3_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF980EC) // (US3) US ADDRSIZE REGISTER 
+#define AT91C_US3_CSR   (AT91_CAST(AT91_REG *) 	0xFFF98014) // (US3) Channel Status Register
+#define AT91C_US3_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF980F4) // (US3) US IPNAME2 REGISTER 
+#define AT91C_US3_IER   (AT91_CAST(AT91_REG *) 	0xFFF98008) // (US3) Interrupt Enable Register
+#define AT91C_US3_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF980F8) // (US3) US FEATURES REGISTER 
+#define AT91C_US3_MR    (AT91_CAST(AT91_REG *) 	0xFFF98004) // (US3) Mode Register
+#define AT91C_US3_IF    (AT91_CAST(AT91_REG *) 	0xFFF9804C) // (US3) IRDA_FILTER Register
+#define AT91C_US3_THR   (AT91_CAST(AT91_REG *) 	0xFFF9801C) // (US3) Transmitter Holding Register
+#define AT91C_US3_IMR   (AT91_CAST(AT91_REG *) 	0xFFF98010) // (US3) Interrupt Mask Register
+#define AT91C_US3_FIDI  (AT91_CAST(AT91_REG *) 	0xFFF98040) // (US3) FI_DI_Ratio Register
+#define AT91C_US3_RHR   (AT91_CAST(AT91_REG *) 	0xFFF98018) // (US3) Receiver Holding Register
+#define AT91C_US3_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF980F0) // (US3) US IPNAME1 REGISTER 
+// ========== Register definition for PDC_SSC0 peripheral ========== 
+#define AT91C_SSC0_TNPR (AT91_CAST(AT91_REG *) 	0xFFF9C118) // (PDC_SSC0) Transmit Next Pointer Register
+#define AT91C_SSC0_PTSR (AT91_CAST(AT91_REG *) 	0xFFF9C124) // (PDC_SSC0) PDC Transfer Status Register
+#define AT91C_SSC0_TNCR (AT91_CAST(AT91_REG *) 	0xFFF9C11C) // (PDC_SSC0) Transmit Next Counter Register
+#define AT91C_SSC0_RNCR (AT91_CAST(AT91_REG *) 	0xFFF9C114) // (PDC_SSC0) Receive Next Counter Register
+#define AT91C_SSC0_TPR  (AT91_CAST(AT91_REG *) 	0xFFF9C108) // (PDC_SSC0) Transmit Pointer Register
+#define AT91C_SSC0_RCR  (AT91_CAST(AT91_REG *) 	0xFFF9C104) // (PDC_SSC0) Receive Counter Register
+#define AT91C_SSC0_PTCR (AT91_CAST(AT91_REG *) 	0xFFF9C120) // (PDC_SSC0) PDC Transfer Control Register
+#define AT91C_SSC0_RNPR (AT91_CAST(AT91_REG *) 	0xFFF9C110) // (PDC_SSC0) Receive Next Pointer Register
+#define AT91C_SSC0_TCR  (AT91_CAST(AT91_REG *) 	0xFFF9C10C) // (PDC_SSC0) Transmit Counter Register
+#define AT91C_SSC0_RPR  (AT91_CAST(AT91_REG *) 	0xFFF9C100) // (PDC_SSC0) Receive Pointer Register
+// ========== Register definition for SSC0 peripheral ========== 
+#define AT91C_SSC0_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF9C0F4) // (SSC0) SSC IPNAME2 REGISTER 
+#define AT91C_SSC0_SR   (AT91_CAST(AT91_REG *) 	0xFFF9C040) // (SSC0) Status Register
+#define AT91C_SSC0_TSHR (AT91_CAST(AT91_REG *) 	0xFFF9C034) // (SSC0) Transmit Sync Holding Register
+#define AT91C_SSC0_TCMR (AT91_CAST(AT91_REG *) 	0xFFF9C018) // (SSC0) Transmit Clock Mode Register
+#define AT91C_SSC0_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF9C0EC) // (SSC0) SSC ADDRSIZE REGISTER 
+#define AT91C_SSC0_IMR  (AT91_CAST(AT91_REG *) 	0xFFF9C04C) // (SSC0) Interrupt Mask Register
+#define AT91C_SSC0_IDR  (AT91_CAST(AT91_REG *) 	0xFFF9C048) // (SSC0) Interrupt Disable Register
+#define AT91C_SSC0_CR   (AT91_CAST(AT91_REG *) 	0xFFF9C000) // (SSC0) Control Register
+#define AT91C_SSC0_VER  (AT91_CAST(AT91_REG *) 	0xFFF9C0FC) // (SSC0) Version Register
+#define AT91C_SSC0_RHR  (AT91_CAST(AT91_REG *) 	0xFFF9C020) // (SSC0) Receive Holding Register
+#define AT91C_SSC0_THR  (AT91_CAST(AT91_REG *) 	0xFFF9C024) // (SSC0) Transmit Holding Register
+#define AT91C_SSC0_CMR  (AT91_CAST(AT91_REG *) 	0xFFF9C004) // (SSC0) Clock Mode Register
+#define AT91C_SSC0_FEATURES (AT91_CAST(AT91_REG *) 	0xFFF9C0F8) // (SSC0) SSC FEATURES REGISTER 
+#define AT91C_SSC0_RCMR (AT91_CAST(AT91_REG *) 	0xFFF9C010) // (SSC0) Receive Clock ModeRegister
+#define AT91C_SSC0_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF9C0F0) // (SSC0) SSC IPNAME1 REGISTER 
+#define AT91C_SSC0_RSHR (AT91_CAST(AT91_REG *) 	0xFFF9C030) // (SSC0) Receive Sync Holding Register
+#define AT91C_SSC0_IER  (AT91_CAST(AT91_REG *) 	0xFFF9C044) // (SSC0) Interrupt Enable Register
+#define AT91C_SSC0_TFMR (AT91_CAST(AT91_REG *) 	0xFFF9C01C) // (SSC0) Transmit Frame Mode Register
+#define AT91C_SSC0_RFMR (AT91_CAST(AT91_REG *) 	0xFFF9C014) // (SSC0) Receive Frame Mode Register
+// ========== Register definition for PDC_SSC1 peripheral ========== 
+#define AT91C_SSC1_RNPR (AT91_CAST(AT91_REG *) 	0xFFFA0110) // (PDC_SSC1) Receive Next Pointer Register
+#define AT91C_SSC1_TCR  (AT91_CAST(AT91_REG *) 	0xFFFA010C) // (PDC_SSC1) Transmit Counter Register
+#define AT91C_SSC1_TNCR (AT91_CAST(AT91_REG *) 	0xFFFA011C) // (PDC_SSC1) Transmit Next Counter Register
+#define AT91C_SSC1_RCR  (AT91_CAST(AT91_REG *) 	0xFFFA0104) // (PDC_SSC1) Receive Counter Register
+#define AT91C_SSC1_RNCR (AT91_CAST(AT91_REG *) 	0xFFFA0114) // (PDC_SSC1) Receive Next Counter Register
+#define AT91C_SSC1_PTCR (AT91_CAST(AT91_REG *) 	0xFFFA0120) // (PDC_SSC1) PDC Transfer Control Register
+#define AT91C_SSC1_TPR  (AT91_CAST(AT91_REG *) 	0xFFFA0108) // (PDC_SSC1) Transmit Pointer Register
+#define AT91C_SSC1_RPR  (AT91_CAST(AT91_REG *) 	0xFFFA0100) // (PDC_SSC1) Receive Pointer Register
+#define AT91C_SSC1_PTSR (AT91_CAST(AT91_REG *) 	0xFFFA0124) // (PDC_SSC1) PDC Transfer Status Register
+#define AT91C_SSC1_TNPR (AT91_CAST(AT91_REG *) 	0xFFFA0118) // (PDC_SSC1) Transmit Next Pointer Register
+// ========== Register definition for SSC1 peripheral ========== 
+#define AT91C_SSC1_SR   (AT91_CAST(AT91_REG *) 	0xFFFA0040) // (SSC1) Status Register
+#define AT91C_SSC1_TFMR (AT91_CAST(AT91_REG *) 	0xFFFA001C) // (SSC1) Transmit Frame Mode Register
+#define AT91C_SSC1_IPNAME1 (AT91_CAST(AT91_REG *) 	0xFFFA00F0) // (SSC1) SSC IPNAME1 REGISTER 
+#define AT91C_SSC1_CMR  (AT91_CAST(AT91_REG *) 	0xFFFA0004) // (SSC1) Clock Mode Register
+#define AT91C_SSC1_THR  (AT91_CAST(AT91_REG *) 	0xFFFA0024) // (SSC1) Transmit Holding Register
+#define AT91C_SSC1_FEATURES (AT91_CAST(AT91_REG *) 	0xFFFA00F8) // (SSC1) SSC FEATURES REGISTER 
+#define AT91C_SSC1_TSHR (AT91_CAST(AT91_REG *) 	0xFFFA0034) // (SSC1) Transmit Sync Holding Register
+#define AT91C_SSC1_RCMR (AT91_CAST(AT91_REG *) 	0xFFFA0010) // (SSC1) Receive Clock ModeRegister
+#define AT91C_SSC1_RHR  (AT91_CAST(AT91_REG *) 	0xFFFA0020) // (SSC1) Receive Holding Register
+#define AT91C_SSC1_VER  (AT91_CAST(AT91_REG *) 	0xFFFA00FC) // (SSC1) Version Register
+#define AT91C_SSC1_TCMR (AT91_CAST(AT91_REG *) 	0xFFFA0018) // (SSC1) Transmit Clock Mode Register
+#define AT91C_SSC1_CR   (AT91_CAST(AT91_REG *) 	0xFFFA0000) // (SSC1) Control Register
+#define AT91C_SSC1_RSHR (AT91_CAST(AT91_REG *) 	0xFFFA0030) // (SSC1) Receive Sync Holding Register
+#define AT91C_SSC1_IER  (AT91_CAST(AT91_REG *) 	0xFFFA0044) // (SSC1) Interrupt Enable Register
+#define AT91C_SSC1_ADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFFA00EC) // (SSC1) SSC ADDRSIZE REGISTER 
+#define AT91C_SSC1_RFMR (AT91_CAST(AT91_REG *) 	0xFFFA0014) // (SSC1) Receive Frame Mode Register
+#define AT91C_SSC1_IMR  (AT91_CAST(AT91_REG *) 	0xFFFA004C) // (SSC1) Interrupt Mask Register
+#define AT91C_SSC1_IDR  (AT91_CAST(AT91_REG *) 	0xFFFA0048) // (SSC1) Interrupt Disable Register
+#define AT91C_SSC1_IPNAME2 (AT91_CAST(AT91_REG *) 	0xFFFA00F4) // (SSC1) SSC IPNAME2 REGISTER 
+// ========== Register definition for PWMC_CH0 peripheral ========== 
+#define AT91C_PWMC_CH0_CCNTR (AT91_CAST(AT91_REG *) 	0xFFFB820C) // (PWMC_CH0) Channel Counter Register
+#define AT91C_PWMC_CH0_CPRDR (AT91_CAST(AT91_REG *) 	0xFFFB8208) // (PWMC_CH0) Channel Period Register
+#define AT91C_PWMC_CH0_CUPDR (AT91_CAST(AT91_REG *) 	0xFFFB8210) // (PWMC_CH0) Channel Update Register
+#define AT91C_PWMC_CH0_CDTYR (AT91_CAST(AT91_REG *) 	0xFFFB8204) // (PWMC_CH0) Channel Duty Cycle Register
+#define AT91C_PWMC_CH0_CMR (AT91_CAST(AT91_REG *) 	0xFFFB8200) // (PWMC_CH0) Channel Mode Register
+#define AT91C_PWMC_CH0_Reserved (AT91_CAST(AT91_REG *) 	0xFFFB8214) // (PWMC_CH0) Reserved
+// ========== Register definition for PWMC_CH1 peripheral ========== 
+#define AT91C_PWMC_CH1_CCNTR (AT91_CAST(AT91_REG *) 	0xFFFB822C) // (PWMC_CH1) Channel Counter Register
+#define AT91C_PWMC_CH1_CDTYR (AT91_CAST(AT91_REG *) 	0xFFFB8224) // (PWMC_CH1) Channel Duty Cycle Register
+#define AT91C_PWMC_CH1_CMR (AT91_CAST(AT91_REG *) 	0xFFFB8220) // (PWMC_CH1) Channel Mode Register
+#define AT91C_PWMC_CH1_CPRDR (AT91_CAST(AT91_REG *) 	0xFFFB8228) // (PWMC_CH1) Channel Period Register
+#define AT91C_PWMC_CH1_Reserved (AT91_CAST(AT91_REG *) 	0xFFFB8234) // (PWMC_CH1) Reserved
+#define AT91C_PWMC_CH1_CUPDR (AT91_CAST(AT91_REG *) 	0xFFFB8230) // (PWMC_CH1) Channel Update Register
+// ========== Register definition for PWMC_CH2 peripheral ========== 
+#define AT91C_PWMC_CH2_CUPDR (AT91_CAST(AT91_REG *) 	0xFFFB8250) // (PWMC_CH2) Channel Update Register
+#define AT91C_PWMC_CH2_CMR (AT91_CAST(AT91_REG *) 	0xFFFB8240) // (PWMC_CH2) Channel Mode Register
+#define AT91C_PWMC_CH2_Reserved (AT91_CAST(AT91_REG *) 	0xFFFB8254) // (PWMC_CH2) Reserved
+#define AT91C_PWMC_CH2_CPRDR (AT91_CAST(AT91_REG *) 	0xFFFB8248) // (PWMC_CH2) Channel Period Register
+#define AT91C_PWMC_CH2_CDTYR (AT91_CAST(AT91_REG *) 	0xFFFB8244) // (PWMC_CH2) Channel Duty Cycle Register
+#define AT91C_PWMC_CH2_CCNTR (AT91_CAST(AT91_REG *) 	0xFFFB824C) // (PWMC_CH2) Channel Counter Register
+// ========== Register definition for PWMC_CH3 peripheral ========== 
+#define AT91C_PWMC_CH3_CPRDR (AT91_CAST(AT91_REG *) 	0xFFFB8268) // (PWMC_CH3) Channel Period Register
+#define AT91C_PWMC_CH3_Reserved (AT91_CAST(AT91_REG *) 	0xFFFB8274) // (PWMC_CH3) Reserved
+#define AT91C_PWMC_CH3_CUPDR (AT91_CAST(AT91_REG *) 	0xFFFB8270) // (PWMC_CH3) Channel Update Register
+#define AT91C_PWMC_CH3_CDTYR (AT91_CAST(AT91_REG *) 	0xFFFB8264) // (PWMC_CH3) Channel Duty Cycle Register
+#define AT91C_PWMC_CH3_CCNTR (AT91_CAST(AT91_REG *) 	0xFFFB826C) // (PWMC_CH3) Channel Counter Register
+#define AT91C_PWMC_CH3_CMR (AT91_CAST(AT91_REG *) 	0xFFFB8260) // (PWMC_CH3) Channel Mode Register
+// ========== Register definition for PWMC peripheral ========== 
+#define AT91C_PWMC_IDR  (AT91_CAST(AT91_REG *) 	0xFFFB8014) // (PWMC) PWMC Interrupt Disable Register
+#define AT91C_PWMC_MR   (AT91_CAST(AT91_REG *) 	0xFFFB8000) // (PWMC) PWMC Mode Register
+#define AT91C_PWMC_VR   (AT91_CAST(AT91_REG *) 	0xFFFB80FC) // (PWMC) PWMC Version Register
+#define AT91C_PWMC_IMR  (AT91_CAST(AT91_REG *) 	0xFFFB8018) // (PWMC) PWMC Interrupt Mask Register
+#define AT91C_PWMC_SR   (AT91_CAST(AT91_REG *) 	0xFFFB800C) // (PWMC) PWMC Status Register
+#define AT91C_PWMC_ISR  (AT91_CAST(AT91_REG *) 	0xFFFB801C) // (PWMC) PWMC Interrupt Status Register
+#define AT91C_PWMC_ENA  (AT91_CAST(AT91_REG *) 	0xFFFB8004) // (PWMC) PWMC Enable Register
+#define AT91C_PWMC_IER  (AT91_CAST(AT91_REG *) 	0xFFFB8010) // (PWMC) PWMC Interrupt Enable Register
+#define AT91C_PWMC_DIS  (AT91_CAST(AT91_REG *) 	0xFFFB8008) // (PWMC) PWMC Disable Register
+// ========== Register definition for PDC_SPI0 peripheral ========== 
+#define AT91C_SPI0_TPR  (AT91_CAST(AT91_REG *) 	0xFFFA4108) // (PDC_SPI0) Transmit Pointer Register
+#define AT91C_SPI0_PTCR (AT91_CAST(AT91_REG *) 	0xFFFA4120) // (PDC_SPI0) PDC Transfer Control Register
+#define AT91C_SPI0_RNPR (AT91_CAST(AT91_REG *) 	0xFFFA4110) // (PDC_SPI0) Receive Next Pointer Register
+#define AT91C_SPI0_TNCR (AT91_CAST(AT91_REG *) 	0xFFFA411C) // (PDC_SPI0) Transmit Next Counter Register
+#define AT91C_SPI0_TCR  (AT91_CAST(AT91_REG *) 	0xFFFA410C) // (PDC_SPI0) Transmit Counter Register
+#define AT91C_SPI0_RCR  (AT91_CAST(AT91_REG *) 	0xFFFA4104) // (PDC_SPI0) Receive Counter Register
+#define AT91C_SPI0_RNCR (AT91_CAST(AT91_REG *) 	0xFFFA4114) // (PDC_SPI0) Receive Next Counter Register
+#define AT91C_SPI0_TNPR (AT91_CAST(AT91_REG *) 	0xFFFA4118) // (PDC_SPI0) Transmit Next Pointer Register
+#define AT91C_SPI0_RPR  (AT91_CAST(AT91_REG *) 	0xFFFA4100) // (PDC_SPI0) Receive Pointer Register
+#define AT91C_SPI0_PTSR (AT91_CAST(AT91_REG *) 	0xFFFA4124) // (PDC_SPI0) PDC Transfer Status Register
+// ========== Register definition for PDC_SPI1 peripheral ========== 
+#define AT91C_SPI1_RNCR (AT91_CAST(AT91_REG *) 	0xFFFA8114) // (PDC_SPI1) Receive Next Counter Register
+#define AT91C_SPI1_TCR  (AT91_CAST(AT91_REG *) 	0xFFFA810C) // (PDC_SPI1) Transmit Counter Register
+#define AT91C_SPI1_RCR  (AT91_CAST(AT91_REG *) 	0xFFFA8104) // (PDC_SPI1) Receive Counter Register
+#define AT91C_SPI1_TNPR (AT91_CAST(AT91_REG *) 	0xFFFA8118) // (PDC_SPI1) Transmit Next Pointer Register
+#define AT91C_SPI1_RNPR (AT91_CAST(AT91_REG *) 	0xFFFA8110) // (PDC_SPI1) Receive Next Pointer Register
+#define AT91C_SPI1_RPR  (AT91_CAST(AT91_REG *) 	0xFFFA8100) // (PDC_SPI1) Receive Pointer Register
+#define AT91C_SPI1_TNCR (AT91_CAST(AT91_REG *) 	0xFFFA811C) // (PDC_SPI1) Transmit Next Counter Register
+#define AT91C_SPI1_TPR  (AT91_CAST(AT91_REG *) 	0xFFFA8108) // (PDC_SPI1) Transmit Pointer Register
+#define AT91C_SPI1_PTSR (AT91_CAST(AT91_REG *) 	0xFFFA8124) // (PDC_SPI1) PDC Transfer Status Register
+#define AT91C_SPI1_PTCR (AT91_CAST(AT91_REG *) 	0xFFFA8120) // (PDC_SPI1) PDC Transfer Control Register
+// ========== Register definition for SPI0 peripheral ========== 
+#define AT91C_SPI0_MR   (AT91_CAST(AT91_REG *) 	0xFFFA4004) // (SPI0) Mode Register
+#define AT91C_SPI0_RDR  (AT91_CAST(AT91_REG *) 	0xFFFA4008) // (SPI0) Receive Data Register
+#define AT91C_SPI0_CR   (AT91_CAST(AT91_REG *) 	0xFFFA4000) // (SPI0) Control Register
+#define AT91C_SPI0_IER  (AT91_CAST(AT91_REG *) 	0xFFFA4014) // (SPI0) Interrupt Enable Register
+#define AT91C_SPI0_TDR  (AT91_CAST(AT91_REG *) 	0xFFFA400C) // (SPI0) Transmit Data Register
+#define AT91C_SPI0_IDR  (AT91_CAST(AT91_REG *) 	0xFFFA4018) // (SPI0) Interrupt Disable Register
+#define AT91C_SPI0_CSR  (AT91_CAST(AT91_REG *) 	0xFFFA4030) // (SPI0) Chip Select Register
+#define AT91C_SPI0_SR   (AT91_CAST(AT91_REG *) 	0xFFFA4010) // (SPI0) Status Register
+#define AT91C_SPI0_IMR  (AT91_CAST(AT91_REG *) 	0xFFFA401C) // (SPI0) Interrupt Mask Register
+// ========== Register definition for SPI1 peripheral ========== 
+#define AT91C_SPI1_CSR  (AT91_CAST(AT91_REG *) 	0xFFFA8030) // (SPI1) Chip Select Register
+#define AT91C_SPI1_IER  (AT91_CAST(AT91_REG *) 	0xFFFA8014) // (SPI1) Interrupt Enable Register
+#define AT91C_SPI1_RDR  (AT91_CAST(AT91_REG *) 	0xFFFA8008) // (SPI1) Receive Data Register
+#define AT91C_SPI1_IDR  (AT91_CAST(AT91_REG *) 	0xFFFA8018) // (SPI1) Interrupt Disable Register
+#define AT91C_SPI1_MR   (AT91_CAST(AT91_REG *) 	0xFFFA8004) // (SPI1) Mode Register
+#define AT91C_SPI1_CR   (AT91_CAST(AT91_REG *) 	0xFFFA8000) // (SPI1) Control Register
+#define AT91C_SPI1_SR   (AT91_CAST(AT91_REG *) 	0xFFFA8010) // (SPI1) Status Register
+#define AT91C_SPI1_TDR  (AT91_CAST(AT91_REG *) 	0xFFFA800C) // (SPI1) Transmit Data Register
+#define AT91C_SPI1_IMR  (AT91_CAST(AT91_REG *) 	0xFFFA801C) // (SPI1) Interrupt Mask Register
+// ========== Register definition for PDC_TSADC peripheral ========== 
+#define AT91C_TSADC_TCR (AT91_CAST(AT91_REG *) 	0xFFFB010C) // (PDC_TSADC) Transmit Counter Register
+#define AT91C_TSADC_PTCR (AT91_CAST(AT91_REG *) 	0xFFFB0120) // (PDC_TSADC) PDC Transfer Control Register
+#define AT91C_TSADC_RNCR (AT91_CAST(AT91_REG *) 	0xFFFB0114) // (PDC_TSADC) Receive Next Counter Register
+#define AT91C_TSADC_PTSR (AT91_CAST(AT91_REG *) 	0xFFFB0124) // (PDC_TSADC) PDC Transfer Status Register
+#define AT91C_TSADC_TNCR (AT91_CAST(AT91_REG *) 	0xFFFB011C) // (PDC_TSADC) Transmit Next Counter Register
+#define AT91C_TSADC_RNPR (AT91_CAST(AT91_REG *) 	0xFFFB0110) // (PDC_TSADC) Receive Next Pointer Register
+#define AT91C_TSADC_RCR (AT91_CAST(AT91_REG *) 	0xFFFB0104) // (PDC_TSADC) Receive Counter Register
+#define AT91C_TSADC_TPR (AT91_CAST(AT91_REG *) 	0xFFFB0108) // (PDC_TSADC) Transmit Pointer Register
+#define AT91C_TSADC_TNPR (AT91_CAST(AT91_REG *) 	0xFFFB0118) // (PDC_TSADC) Transmit Next Pointer Register
+#define AT91C_TSADC_RPR (AT91_CAST(AT91_REG *) 	0xFFFB0100) // (PDC_TSADC) Receive Pointer Register
+// ========== Register definition for TSADC peripheral ========== 
+#define AT91C_TSADC_CHSR (AT91_CAST(AT91_REG *) 	0xFFFB0018) // (TSADC) Channel Status Register
+#define AT91C_TSADC_CDR5 (AT91_CAST(AT91_REG *) 	0xFFFB0044) // (TSADC) Channel Data Register 5
+#define AT91C_TSADC_CR  (AT91_CAST(AT91_REG *) 	0xFFFB0000) // (TSADC) Control Register
+#define AT91C_TSADC_IMR (AT91_CAST(AT91_REG *) 	0xFFFB002C) // (TSADC) Interrupt Mask Register
+#define AT91C_TSADC_CHDR (AT91_CAST(AT91_REG *) 	0xFFFB0014) // (TSADC) Channel Disable Register
+#define AT91C_TSADC_LCDR (AT91_CAST(AT91_REG *) 	0xFFFB0020) // (TSADC) Last Converted Register
+#define AT91C_TSADC_IER (AT91_CAST(AT91_REG *) 	0xFFFB0024) // (TSADC) Interrupt Enable Register
+#define AT91C_TSADC_TSR (AT91_CAST(AT91_REG *) 	0xFFFB000C) // (TSADC) Touch Screen Register
+#define AT91C_TSADC_CDR2 (AT91_CAST(AT91_REG *) 	0xFFFB0038) // (TSADC) Channel Data Register 2
+#define AT91C_TSADC_CDR4 (AT91_CAST(AT91_REG *) 	0xFFFB0040) // (TSADC) Channel Data Register 4
+#define AT91C_TSADC_CHER (AT91_CAST(AT91_REG *) 	0xFFFB0010) // (TSADC) Channel Enable Register
+#define AT91C_TSADC_TRGR (AT91_CAST(AT91_REG *) 	0xFFFB0008) // (TSADC) Trigger Register
+#define AT91C_TSADC_CDR3 (AT91_CAST(AT91_REG *) 	0xFFFB003C) // (TSADC) Channel Data Register 3
+#define AT91C_TSADC_SR  (AT91_CAST(AT91_REG *) 	0xFFFB001C) // (TSADC) Status Register
+#define AT91C_TSADC_CDR0 (AT91_CAST(AT91_REG *) 	0xFFFB0030) // (TSADC) Channel Data Register 0
+#define AT91C_TSADC_CDR6 (AT91_CAST(AT91_REG *) 	0xFFFB0048) // (TSADC) Channel Data Register 6
+#define AT91C_TSADC_IDR (AT91_CAST(AT91_REG *) 	0xFFFB0028) // (TSADC) Interrupt Disable Register
+#define AT91C_TSADC_MR  (AT91_CAST(AT91_REG *) 	0xFFFB0004) // (TSADC) Mode Register
+#define AT91C_TSADC_CDR7 (AT91_CAST(AT91_REG *) 	0xFFFB004C) // (TSADC) Channel Data Register 7
+#define AT91C_TSADC_CDR1 (AT91_CAST(AT91_REG *) 	0xFFFB0034) // (TSADC) Channel Data Register 1
+// ========== Register definition for UDPHS_EPTFIFO peripheral ========== 
+#define AT91C_UDPHS_EPTFIFO_READEPT3 (AT91_CAST(AT91_REG *) 	0x00630000) // (UDPHS_EPTFIFO) FIFO Endpoint Data Register 3
+#define AT91C_UDPHS_EPTFIFO_READEPT5 (AT91_CAST(AT91_REG *) 	0x00650000) // (UDPHS_EPTFIFO) FIFO Endpoint Data Register 5
+#define AT91C_UDPHS_EPTFIFO_READEPT1 (AT91_CAST(AT91_REG *) 	0x00610000) // (UDPHS_EPTFIFO) FIFO Endpoint Data Register 1
+#define AT91C_UDPHS_EPTFIFO_READEPT0 (AT91_CAST(AT91_REG *) 	0x00600000) // (UDPHS_EPTFIFO) FIFO Endpoint Data Register 0
+#define AT91C_UDPHS_EPTFIFO_READEPT6 (AT91_CAST(AT91_REG *) 	0x00660000) // (UDPHS_EPTFIFO) FIFO Endpoint Data Register 6
+#define AT91C_UDPHS_EPTFIFO_READEPT2 (AT91_CAST(AT91_REG *) 	0x00620000) // (UDPHS_EPTFIFO) FIFO Endpoint Data Register 2
+#define AT91C_UDPHS_EPTFIFO_READEPT4 (AT91_CAST(AT91_REG *) 	0x00640000) // (UDPHS_EPTFIFO) FIFO Endpoint Data Register 4
+// ========== Register definition for UDPHS_EPT_0 peripheral ========== 
+#define AT91C_UDPHS_EPT_0_EPTSTA (AT91_CAST(AT91_REG *) 	0xFFF7811C) // (UDPHS_EPT_0) UDPHS Endpoint Status Register
+#define AT91C_UDPHS_EPT_0_EPTCTL (AT91_CAST(AT91_REG *) 	0xFFF7810C) // (UDPHS_EPT_0) UDPHS Endpoint Control Register
+#define AT91C_UDPHS_EPT_0_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0xFFF78108) // (UDPHS_EPT_0) UDPHS Endpoint Control Disable Register
+#define AT91C_UDPHS_EPT_0_EPTCFG (AT91_CAST(AT91_REG *) 	0xFFF78100) // (UDPHS_EPT_0) UDPHS Endpoint Config Register
+#define AT91C_UDPHS_EPT_0_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0xFFF78118) // (UDPHS_EPT_0) UDPHS Endpoint Clear Status Register
+#define AT91C_UDPHS_EPT_0_EPTSETSTA (AT91_CAST(AT91_REG *) 	0xFFF78114) // (UDPHS_EPT_0) UDPHS Endpoint Set Status Register
+#define AT91C_UDPHS_EPT_0_EPTCTLENB (AT91_CAST(AT91_REG *) 	0xFFF78104) // (UDPHS_EPT_0) UDPHS Endpoint Control Enable Register
+// ========== Register definition for UDPHS_EPT_1 peripheral ========== 
+#define AT91C_UDPHS_EPT_1_EPTCTLENB (AT91_CAST(AT91_REG *) 	0xFFF78124) // (UDPHS_EPT_1) UDPHS Endpoint Control Enable Register
+#define AT91C_UDPHS_EPT_1_EPTCFG (AT91_CAST(AT91_REG *) 	0xFFF78120) // (UDPHS_EPT_1) UDPHS Endpoint Config Register
+#define AT91C_UDPHS_EPT_1_EPTCTL (AT91_CAST(AT91_REG *) 	0xFFF7812C) // (UDPHS_EPT_1) UDPHS Endpoint Control Register
+#define AT91C_UDPHS_EPT_1_EPTSTA (AT91_CAST(AT91_REG *) 	0xFFF7813C) // (UDPHS_EPT_1) UDPHS Endpoint Status Register
+#define AT91C_UDPHS_EPT_1_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0xFFF78138) // (UDPHS_EPT_1) UDPHS Endpoint Clear Status Register
+#define AT91C_UDPHS_EPT_1_EPTSETSTA (AT91_CAST(AT91_REG *) 	0xFFF78134) // (UDPHS_EPT_1) UDPHS Endpoint Set Status Register
+#define AT91C_UDPHS_EPT_1_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0xFFF78128) // (UDPHS_EPT_1) UDPHS Endpoint Control Disable Register
+// ========== Register definition for UDPHS_EPT_2 peripheral ========== 
+#define AT91C_UDPHS_EPT_2_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0xFFF78158) // (UDPHS_EPT_2) UDPHS Endpoint Clear Status Register
+#define AT91C_UDPHS_EPT_2_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0xFFF78148) // (UDPHS_EPT_2) UDPHS Endpoint Control Disable Register
+#define AT91C_UDPHS_EPT_2_EPTSTA (AT91_CAST(AT91_REG *) 	0xFFF7815C) // (UDPHS_EPT_2) UDPHS Endpoint Status Register
+#define AT91C_UDPHS_EPT_2_EPTSETSTA (AT91_CAST(AT91_REG *) 	0xFFF78154) // (UDPHS_EPT_2) UDPHS Endpoint Set Status Register
+#define AT91C_UDPHS_EPT_2_EPTCTL (AT91_CAST(AT91_REG *) 	0xFFF7814C) // (UDPHS_EPT_2) UDPHS Endpoint Control Register
+#define AT91C_UDPHS_EPT_2_EPTCFG (AT91_CAST(AT91_REG *) 	0xFFF78140) // (UDPHS_EPT_2) UDPHS Endpoint Config Register
+#define AT91C_UDPHS_EPT_2_EPTCTLENB (AT91_CAST(AT91_REG *) 	0xFFF78144) // (UDPHS_EPT_2) UDPHS Endpoint Control Enable Register
+// ========== Register definition for UDPHS_EPT_3 peripheral ========== 
+#define AT91C_UDPHS_EPT_3_EPTCTL (AT91_CAST(AT91_REG *) 	0xFFF7816C) // (UDPHS_EPT_3) UDPHS Endpoint Control Register
+#define AT91C_UDPHS_EPT_3_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0xFFF78178) // (UDPHS_EPT_3) UDPHS Endpoint Clear Status Register
+#define AT91C_UDPHS_EPT_3_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0xFFF78168) // (UDPHS_EPT_3) UDPHS Endpoint Control Disable Register
+#define AT91C_UDPHS_EPT_3_EPTSTA (AT91_CAST(AT91_REG *) 	0xFFF7817C) // (UDPHS_EPT_3) UDPHS Endpoint Status Register
+#define AT91C_UDPHS_EPT_3_EPTSETSTA (AT91_CAST(AT91_REG *) 	0xFFF78174) // (UDPHS_EPT_3) UDPHS Endpoint Set Status Register
+#define AT91C_UDPHS_EPT_3_EPTCTLENB (AT91_CAST(AT91_REG *) 	0xFFF78164) // (UDPHS_EPT_3) UDPHS Endpoint Control Enable Register
+#define AT91C_UDPHS_EPT_3_EPTCFG (AT91_CAST(AT91_REG *) 	0xFFF78160) // (UDPHS_EPT_3) UDPHS Endpoint Config Register
+// ========== Register definition for UDPHS_EPT_4 peripheral ========== 
+#define AT91C_UDPHS_EPT_4_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0xFFF78198) // (UDPHS_EPT_4) UDPHS Endpoint Clear Status Register
+#define AT91C_UDPHS_EPT_4_EPTCTL (AT91_CAST(AT91_REG *) 	0xFFF7818C) // (UDPHS_EPT_4) UDPHS Endpoint Control Register
+#define AT91C_UDPHS_EPT_4_EPTCTLENB (AT91_CAST(AT91_REG *) 	0xFFF78184) // (UDPHS_EPT_4) UDPHS Endpoint Control Enable Register
+#define AT91C_UDPHS_EPT_4_EPTSTA (AT91_CAST(AT91_REG *) 	0xFFF7819C) // (UDPHS_EPT_4) UDPHS Endpoint Status Register
+#define AT91C_UDPHS_EPT_4_EPTSETSTA (AT91_CAST(AT91_REG *) 	0xFFF78194) // (UDPHS_EPT_4) UDPHS Endpoint Set Status Register
+#define AT91C_UDPHS_EPT_4_EPTCFG (AT91_CAST(AT91_REG *) 	0xFFF78180) // (UDPHS_EPT_4) UDPHS Endpoint Config Register
+#define AT91C_UDPHS_EPT_4_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0xFFF78188) // (UDPHS_EPT_4) UDPHS Endpoint Control Disable Register
+// ========== Register definition for UDPHS_EPT_5 peripheral ========== 
+#define AT91C_UDPHS_EPT_5_EPTSTA (AT91_CAST(AT91_REG *) 	0xFFF781BC) // (UDPHS_EPT_5) UDPHS Endpoint Status Register
+#define AT91C_UDPHS_EPT_5_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0xFFF781B8) // (UDPHS_EPT_5) UDPHS Endpoint Clear Status Register
+#define AT91C_UDPHS_EPT_5_EPTCTLENB (AT91_CAST(AT91_REG *) 	0xFFF781A4) // (UDPHS_EPT_5) UDPHS Endpoint Control Enable Register
+#define AT91C_UDPHS_EPT_5_EPTSETSTA (AT91_CAST(AT91_REG *) 	0xFFF781B4) // (UDPHS_EPT_5) UDPHS Endpoint Set Status Register
+#define AT91C_UDPHS_EPT_5_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0xFFF781A8) // (UDPHS_EPT_5) UDPHS Endpoint Control Disable Register
+#define AT91C_UDPHS_EPT_5_EPTCFG (AT91_CAST(AT91_REG *) 	0xFFF781A0) // (UDPHS_EPT_5) UDPHS Endpoint Config Register
+#define AT91C_UDPHS_EPT_5_EPTCTL (AT91_CAST(AT91_REG *) 	0xFFF781AC) // (UDPHS_EPT_5) UDPHS Endpoint Control Register
+// ========== Register definition for UDPHS_EPT_6 peripheral ========== 
+#define AT91C_UDPHS_EPT_6_EPTCLRSTA (AT91_CAST(AT91_REG *) 	0xFFF781D8) // (UDPHS_EPT_6) UDPHS Endpoint Clear Status Register
+#define AT91C_UDPHS_EPT_6_EPTCTLENB (AT91_CAST(AT91_REG *) 	0xFFF781C4) // (UDPHS_EPT_6) UDPHS Endpoint Control Enable Register
+#define AT91C_UDPHS_EPT_6_EPTCTL (AT91_CAST(AT91_REG *) 	0xFFF781CC) // (UDPHS_EPT_6) UDPHS Endpoint Control Register
+#define AT91C_UDPHS_EPT_6_EPTSETSTA (AT91_CAST(AT91_REG *) 	0xFFF781D4) // (UDPHS_EPT_6) UDPHS Endpoint Set Status Register
+#define AT91C_UDPHS_EPT_6_EPTCTLDIS (AT91_CAST(AT91_REG *) 	0xFFF781C8) // (UDPHS_EPT_6) UDPHS Endpoint Control Disable Register
+#define AT91C_UDPHS_EPT_6_EPTSTA (AT91_CAST(AT91_REG *) 	0xFFF781DC) // (UDPHS_EPT_6) UDPHS Endpoint Status Register
+#define AT91C_UDPHS_EPT_6_EPTCFG (AT91_CAST(AT91_REG *) 	0xFFF781C0) // (UDPHS_EPT_6) UDPHS Endpoint Config Register
+// ========== Register definition for UDPHS_DMA_1 peripheral ========== 
+#define AT91C_UDPHS_DMA_1_DMASTATUS (AT91_CAST(AT91_REG *) 	0xFFF7831C) // (UDPHS_DMA_1) UDPHS DMA Channel Status Register
+#define AT91C_UDPHS_DMA_1_DMANXTDSC (AT91_CAST(AT91_REG *) 	0xFFF78310) // (UDPHS_DMA_1) UDPHS DMA Channel Next Descriptor Address
+#define AT91C_UDPHS_DMA_1_DMACONTROL (AT91_CAST(AT91_REG *) 	0xFFF78318) // (UDPHS_DMA_1) UDPHS DMA Channel Control Register
+#define AT91C_UDPHS_DMA_1_DMAADDRESS (AT91_CAST(AT91_REG *) 	0xFFF78314) // (UDPHS_DMA_1) UDPHS DMA Channel Address Register
+// ========== Register definition for UDPHS_DMA_2 peripheral ========== 
+#define AT91C_UDPHS_DMA_2_DMACONTROL (AT91_CAST(AT91_REG *) 	0xFFF78328) // (UDPHS_DMA_2) UDPHS DMA Channel Control Register
+#define AT91C_UDPHS_DMA_2_DMASTATUS (AT91_CAST(AT91_REG *) 	0xFFF7832C) // (UDPHS_DMA_2) UDPHS DMA Channel Status Register
+#define AT91C_UDPHS_DMA_2_DMAADDRESS (AT91_CAST(AT91_REG *) 	0xFFF78324) // (UDPHS_DMA_2) UDPHS DMA Channel Address Register
+#define AT91C_UDPHS_DMA_2_DMANXTDSC (AT91_CAST(AT91_REG *) 	0xFFF78320) // (UDPHS_DMA_2) UDPHS DMA Channel Next Descriptor Address
+// ========== Register definition for UDPHS_DMA_3 peripheral ========== 
+#define AT91C_UDPHS_DMA_3_DMAADDRESS (AT91_CAST(AT91_REG *) 	0xFFF78334) // (UDPHS_DMA_3) UDPHS DMA Channel Address Register
+#define AT91C_UDPHS_DMA_3_DMANXTDSC (AT91_CAST(AT91_REG *) 	0xFFF78330) // (UDPHS_DMA_3) UDPHS DMA Channel Next Descriptor Address
+#define AT91C_UDPHS_DMA_3_DMACONTROL (AT91_CAST(AT91_REG *) 	0xFFF78338) // (UDPHS_DMA_3) UDPHS DMA Channel Control Register
+#define AT91C_UDPHS_DMA_3_DMASTATUS (AT91_CAST(AT91_REG *) 	0xFFF7833C) // (UDPHS_DMA_3) UDPHS DMA Channel Status Register
+// ========== Register definition for UDPHS_DMA_4 peripheral ========== 
+#define AT91C_UDPHS_DMA_4_DMANXTDSC (AT91_CAST(AT91_REG *) 	0xFFF78340) // (UDPHS_DMA_4) UDPHS DMA Channel Next Descriptor Address
+#define AT91C_UDPHS_DMA_4_DMAADDRESS (AT91_CAST(AT91_REG *) 	0xFFF78344) // (UDPHS_DMA_4) UDPHS DMA Channel Address Register
+#define AT91C_UDPHS_DMA_4_DMACONTROL (AT91_CAST(AT91_REG *) 	0xFFF78348) // (UDPHS_DMA_4) UDPHS DMA Channel Control Register
+#define AT91C_UDPHS_DMA_4_DMASTATUS (AT91_CAST(AT91_REG *) 	0xFFF7834C) // (UDPHS_DMA_4) UDPHS DMA Channel Status Register
+// ========== Register definition for UDPHS_DMA_5 peripheral ========== 
+#define AT91C_UDPHS_DMA_5_DMASTATUS (AT91_CAST(AT91_REG *) 	0xFFF7835C) // (UDPHS_DMA_5) UDPHS DMA Channel Status Register
+#define AT91C_UDPHS_DMA_5_DMACONTROL (AT91_CAST(AT91_REG *) 	0xFFF78358) // (UDPHS_DMA_5) UDPHS DMA Channel Control Register
+#define AT91C_UDPHS_DMA_5_DMANXTDSC (AT91_CAST(AT91_REG *) 	0xFFF78350) // (UDPHS_DMA_5) UDPHS DMA Channel Next Descriptor Address
+#define AT91C_UDPHS_DMA_5_DMAADDRESS (AT91_CAST(AT91_REG *) 	0xFFF78354) // (UDPHS_DMA_5) UDPHS DMA Channel Address Register
+// ========== Register definition for UDPHS_DMA_6 peripheral ========== 
+#define AT91C_UDPHS_DMA_6_DMANXTDSC (AT91_CAST(AT91_REG *) 	0xFFF78360) // (UDPHS_DMA_6) UDPHS DMA Channel Next Descriptor Address
+#define AT91C_UDPHS_DMA_6_DMACONTROL (AT91_CAST(AT91_REG *) 	0xFFF78368) // (UDPHS_DMA_6) UDPHS DMA Channel Control Register
+#define AT91C_UDPHS_DMA_6_DMASTATUS (AT91_CAST(AT91_REG *) 	0xFFF7836C) // (UDPHS_DMA_6) UDPHS DMA Channel Status Register
+#define AT91C_UDPHS_DMA_6_DMAADDRESS (AT91_CAST(AT91_REG *) 	0xFFF78364) // (UDPHS_DMA_6) UDPHS DMA Channel Address Register
+// ========== Register definition for UDPHS peripheral ========== 
+#define AT91C_UDPHS_IEN (AT91_CAST(AT91_REG *) 	0xFFF78010) // (UDPHS) UDPHS Interrupt Enable Register
+#define AT91C_UDPHS_TSTSOFCNT (AT91_CAST(AT91_REG *) 	0xFFF780D0) // (UDPHS) UDPHS Test SOF Counter Register
+#define AT91C_UDPHS_IPFEATURES (AT91_CAST(AT91_REG *) 	0xFFF780F8) // (UDPHS) UDPHS Features Register
+#define AT91C_UDPHS_TST (AT91_CAST(AT91_REG *) 	0xFFF780E0) // (UDPHS) UDPHS Test Register
+#define AT91C_UDPHS_FNUM (AT91_CAST(AT91_REG *) 	0xFFF78004) // (UDPHS) UDPHS Frame Number Register
+#define AT91C_UDPHS_TSTCNTB (AT91_CAST(AT91_REG *) 	0xFFF780D8) // (UDPHS) UDPHS Test B Counter Register
+#define AT91C_UDPHS_RIPPADDRSIZE (AT91_CAST(AT91_REG *) 	0xFFF780EC) // (UDPHS) UDPHS PADDRSIZE Register
+#define AT91C_UDPHS_INTSTA (AT91_CAST(AT91_REG *) 	0xFFF78014) // (UDPHS) UDPHS Interrupt Status Register
+#define AT91C_UDPHS_EPTRST (AT91_CAST(AT91_REG *) 	0xFFF7801C) // (UDPHS) UDPHS Endpoints Reset Register
+#define AT91C_UDPHS_TSTCNTA (AT91_CAST(AT91_REG *) 	0xFFF780D4) // (UDPHS) UDPHS Test A Counter Register
+#define AT91C_UDPHS_RIPNAME2 (AT91_CAST(AT91_REG *) 	0xFFF780F4) // (UDPHS) UDPHS Name2 Register
+#define AT91C_UDPHS_RIPNAME1 (AT91_CAST(AT91_REG *) 	0xFFF780F0) // (UDPHS) UDPHS Name1 Register
+#define AT91C_UDPHS_TSTMODREG (AT91_CAST(AT91_REG *) 	0xFFF780DC) // (UDPHS) UDPHS Test Mode Register
+#define AT91C_UDPHS_CLRINT (AT91_CAST(AT91_REG *) 	0xFFF78018) // (UDPHS) UDPHS Clear Interrupt Register
+#define AT91C_UDPHS_IPVERSION (AT91_CAST(AT91_REG *) 	0xFFF780FC) // (UDPHS) UDPHS Version Register
+#define AT91C_UDPHS_CTRL (AT91_CAST(AT91_REG *) 	0xFFF78000) // (UDPHS) UDPHS Control Register
+// ========== Register definition for PDC_AC97C peripheral ========== 
+#define AT91C_AC97C_PTSR (AT91_CAST(AT91_REG *) 	0xFFFAC124) // (PDC_AC97C) PDC Transfer Status Register
+#define AT91C_AC97C_RPR (AT91_CAST(AT91_REG *) 	0xFFFAC100) // (PDC_AC97C) Receive Pointer Register
+#define AT91C_AC97C_RNCR (AT91_CAST(AT91_REG *) 	0xFFFAC114) // (PDC_AC97C) Receive Next Counter Register
+#define AT91C_AC97C_RCR (AT91_CAST(AT91_REG *) 	0xFFFAC104) // (PDC_AC97C) Receive Counter Register
+#define AT91C_AC97C_PTCR (AT91_CAST(AT91_REG *) 	0xFFFAC120) // (PDC_AC97C) PDC Transfer Control Register
+#define AT91C_AC97C_TPR (AT91_CAST(AT91_REG *) 	0xFFFAC108) // (PDC_AC97C) Transmit Pointer Register
+#define AT91C_AC97C_RNPR (AT91_CAST(AT91_REG *) 	0xFFFAC110) // (PDC_AC97C) Receive Next Pointer Register
+#define AT91C_AC97C_TNPR (AT91_CAST(AT91_REG *) 	0xFFFAC118) // (PDC_AC97C) Transmit Next Pointer Register
+#define AT91C_AC97C_TCR (AT91_CAST(AT91_REG *) 	0xFFFAC10C) // (PDC_AC97C) Transmit Counter Register
+#define AT91C_AC97C_TNCR (AT91_CAST(AT91_REG *) 	0xFFFAC11C) // (PDC_AC97C) Transmit Next Counter Register
+// ========== Register definition for AC97C peripheral ========== 
+#define AT91C_AC97C_IER (AT91_CAST(AT91_REG *) 	0xFFFAC054) // (AC97C) Interrupt Enable Register
+#define AT91C_AC97C_COTHR (AT91_CAST(AT91_REG *) 	0xFFFAC044) // (AC97C) COdec Transmit Holding Register
+#define AT91C_AC97C_IDR (AT91_CAST(AT91_REG *) 	0xFFFAC058) // (AC97C) Interrupt Disable Register
+#define AT91C_AC97C_ICA (AT91_CAST(AT91_REG *) 	0xFFFAC010) // (AC97C) Input Channel AssignementRegister
+#define AT91C_AC97C_CATHR (AT91_CAST(AT91_REG *) 	0xFFFAC024) // (AC97C) Channel A Transmit Holding Register
+#define AT91C_AC97C_CBSR (AT91_CAST(AT91_REG *) 	0xFFFAC038) // (AC97C) Channel B Status Register
+#define AT91C_AC97C_CAMR (AT91_CAST(AT91_REG *) 	0xFFFAC02C) // (AC97C) Channel A Mode Register
+#define AT91C_AC97C_SR  (AT91_CAST(AT91_REG *) 	0xFFFAC050) // (AC97C) Status Register
+#define AT91C_AC97C_CBTHR (AT91_CAST(AT91_REG *) 	0xFFFAC034) // (AC97C) Channel B Transmit Holding Register (optional)
+#define AT91C_AC97C_CASR (AT91_CAST(AT91_REG *) 	0xFFFAC028) // (AC97C) Channel A Status Register
+#define AT91C_AC97C_COSR (AT91_CAST(AT91_REG *) 	0xFFFAC048) // (AC97C) CODEC Status Register
+#define AT91C_AC97C_MR  (AT91_CAST(AT91_REG *) 	0xFFFAC008) // (AC97C) Mode Register
+#define AT91C_AC97C_OCA (AT91_CAST(AT91_REG *) 	0xFFFAC014) // (AC97C) Output Channel Assignement Register
+#define AT91C_AC97C_CORHR (AT91_CAST(AT91_REG *) 	0xFFFAC040) // (AC97C) COdec Transmit Holding Register
+#define AT91C_AC97C_CBRHR (AT91_CAST(AT91_REG *) 	0xFFFAC030) // (AC97C) Channel B Receive Holding Register (optional)
+#define AT91C_AC97C_IMR (AT91_CAST(AT91_REG *) 	0xFFFAC05C) // (AC97C) Interrupt Mask Register
+#define AT91C_AC97C_COMR (AT91_CAST(AT91_REG *) 	0xFFFAC04C) // (AC97C) CODEC Mask Status Register
+#define AT91C_AC97C_CARHR (AT91_CAST(AT91_REG *) 	0xFFFAC020) // (AC97C) Channel A Receive Holding Register
+#define AT91C_AC97C_VERSION (AT91_CAST(AT91_REG *) 	0xFFFAC0FC) // (AC97C) Version Register
+#define AT91C_AC97C_CBMR (AT91_CAST(AT91_REG *) 	0xFFFAC03C) // (AC97C) Channel B Mode Register
+// ========== Register definition for LCDC peripheral ========== 
+#define AT91C_LCDC_MVAL (AT91_CAST(AT91_REG *) 	0x00500818) // (LCDC) LCD Mode Toggle Rate Value Register
+#define AT91C_LCDC_PWRCON (AT91_CAST(AT91_REG *) 	0x0050083C) // (LCDC) Power Control Register
+#define AT91C_LCDC_ISR  (AT91_CAST(AT91_REG *) 	0x00500854) // (LCDC) Interrupt Enable Register
+#define AT91C_LCDC_FRMP1 (AT91_CAST(AT91_REG *) 	0x00500008) // (LCDC) DMA Frame Pointer Register 1
+#define AT91C_LCDC_CTRSTVAL (AT91_CAST(AT91_REG *) 	0x00500844) // (LCDC) Contrast Value Register
+#define AT91C_LCDC_ICR  (AT91_CAST(AT91_REG *) 	0x00500858) // (LCDC) Interrupt Clear Register
+#define AT91C_LCDC_TIM1 (AT91_CAST(AT91_REG *) 	0x00500808) // (LCDC) LCD Timing Config 1 Register
+#define AT91C_LCDC_DMACON (AT91_CAST(AT91_REG *) 	0x0050001C) // (LCDC) DMA Control Register
+#define AT91C_LCDC_ITR  (AT91_CAST(AT91_REG *) 	0x00500860) // (LCDC) Interrupts Test Register
+#define AT91C_LCDC_IDR  (AT91_CAST(AT91_REG *) 	0x0050084C) // (LCDC) Interrupt Disable Register
+#define AT91C_LCDC_DP4_7 (AT91_CAST(AT91_REG *) 	0x00500820) // (LCDC) Dithering Pattern DP4_7 Register
+#define AT91C_LCDC_DP5_7 (AT91_CAST(AT91_REG *) 	0x0050082C) // (LCDC) Dithering Pattern DP5_7 Register
+#define AT91C_LCDC_IRR  (AT91_CAST(AT91_REG *) 	0x00500864) // (LCDC) Interrupts Raw Status Register
+#define AT91C_LCDC_DP3_4 (AT91_CAST(AT91_REG *) 	0x00500830) // (LCDC) Dithering Pattern DP3_4 Register
+#define AT91C_LCDC_IMR  (AT91_CAST(AT91_REG *) 	0x00500850) // (LCDC) Interrupt Mask Register
+#define AT91C_LCDC_LCDFRCFG (AT91_CAST(AT91_REG *) 	0x00500810) // (LCDC) LCD Frame Config Register
+#define AT91C_LCDC_CTRSTCON (AT91_CAST(AT91_REG *) 	0x00500840) // (LCDC) Contrast Control Register
+#define AT91C_LCDC_DP1_2 (AT91_CAST(AT91_REG *) 	0x0050081C) // (LCDC) Dithering Pattern DP1_2 Register
+#define AT91C_LCDC_FRMP2 (AT91_CAST(AT91_REG *) 	0x0050000C) // (LCDC) DMA Frame Pointer Register 2
+#define AT91C_LCDC_LCDCON1 (AT91_CAST(AT91_REG *) 	0x00500800) // (LCDC) LCD Control 1 Register
+#define AT91C_LCDC_DP4_5 (AT91_CAST(AT91_REG *) 	0x00500834) // (LCDC) Dithering Pattern DP4_5 Register
+#define AT91C_LCDC_FRMA2 (AT91_CAST(AT91_REG *) 	0x00500014) // (LCDC) DMA Frame Address Register 2
+#define AT91C_LCDC_BA1  (AT91_CAST(AT91_REG *) 	0x00500000) // (LCDC) DMA Base Address Register 1
+#define AT91C_LCDC_DMA2DCFG (AT91_CAST(AT91_REG *) 	0x00500020) // (LCDC) DMA 2D addressing configuration
+#define AT91C_LCDC_LUT_ENTRY (AT91_CAST(AT91_REG *) 	0x00500C00) // (LCDC) LUT Entries Register
+#define AT91C_LCDC_DP6_7 (AT91_CAST(AT91_REG *) 	0x00500838) // (LCDC) Dithering Pattern DP6_7 Register
+#define AT91C_LCDC_FRMCFG (AT91_CAST(AT91_REG *) 	0x00500018) // (LCDC) DMA Frame Configuration Register
+#define AT91C_LCDC_TIM2 (AT91_CAST(AT91_REG *) 	0x0050080C) // (LCDC) LCD Timing Config 2 Register
+#define AT91C_LCDC_DP3_5 (AT91_CAST(AT91_REG *) 	0x00500824) // (LCDC) Dithering Pattern DP3_5 Register
+#define AT91C_LCDC_FRMA1 (AT91_CAST(AT91_REG *) 	0x00500010) // (LCDC) DMA Frame Address Register 1
+#define AT91C_LCDC_IER  (AT91_CAST(AT91_REG *) 	0x00500848) // (LCDC) Interrupt Enable Register
+#define AT91C_LCDC_DP2_3 (AT91_CAST(AT91_REG *) 	0x00500828) // (LCDC) Dithering Pattern DP2_3 Register
+#define AT91C_LCDC_FIFO (AT91_CAST(AT91_REG *) 	0x00500814) // (LCDC) LCD FIFO Register
+#define AT91C_LCDC_BA2  (AT91_CAST(AT91_REG *) 	0x00500004) // (LCDC) DMA Base Address Register 2
+#define AT91C_LCDC_LCDCON2 (AT91_CAST(AT91_REG *) 	0x00500804) // (LCDC) LCD Control 2 Register
+#define AT91C_LCDC_GPR  (AT91_CAST(AT91_REG *) 	0x0050085C) // (LCDC) General Purpose Register
+// ========== Register definition for LCDC_16B_TFT peripheral ========== 
+#define AT91C_TFT_MVAL  (AT91_CAST(AT91_REG *) 	0x00500818) // (LCDC_16B_TFT) LCD Mode Toggle Rate Value Register
+#define AT91C_TFT_PWRCON (AT91_CAST(AT91_REG *) 	0x0050083C) // (LCDC_16B_TFT) Power Control Register
+#define AT91C_TFT_ISR   (AT91_CAST(AT91_REG *) 	0x00500854) // (LCDC_16B_TFT) Interrupt Enable Register
+#define AT91C_TFT_FRMP1 (AT91_CAST(AT91_REG *) 	0x00500008) // (LCDC_16B_TFT) DMA Frame Pointer Register 1
+#define AT91C_TFT_CTRSTVAL (AT91_CAST(AT91_REG *) 	0x00500844) // (LCDC_16B_TFT) Contrast Value Register
+#define AT91C_TFT_ICR   (AT91_CAST(AT91_REG *) 	0x00500858) // (LCDC_16B_TFT) Interrupt Clear Register
+#define AT91C_TFT_TIM1  (AT91_CAST(AT91_REG *) 	0x00500808) // (LCDC_16B_TFT) LCD Timing Config 1 Register
+#define AT91C_TFT_DMACON (AT91_CAST(AT91_REG *) 	0x0050001C) // (LCDC_16B_TFT) DMA Control Register
+#define AT91C_TFT_ITR   (AT91_CAST(AT91_REG *) 	0x00500860) // (LCDC_16B_TFT) Interrupts Test Register
+#define AT91C_TFT_IDR   (AT91_CAST(AT91_REG *) 	0x0050084C) // (LCDC_16B_TFT) Interrupt Disable Register
+#define AT91C_TFT_DP4_7 (AT91_CAST(AT91_REG *) 	0x00500820) // (LCDC_16B_TFT) Dithering Pattern DP4_7 Register
+#define AT91C_TFT_DP5_7 (AT91_CAST(AT91_REG *) 	0x0050082C) // (LCDC_16B_TFT) Dithering Pattern DP5_7 Register
+#define AT91C_TFT_IRR   (AT91_CAST(AT91_REG *) 	0x00500864) // (LCDC_16B_TFT) Interrupts Raw Status Register
+#define AT91C_TFT_DP3_4 (AT91_CAST(AT91_REG *) 	0x00500830) // (LCDC_16B_TFT) Dithering Pattern DP3_4 Register
+#define AT91C_TFT_IMR   (AT91_CAST(AT91_REG *) 	0x00500850) // (LCDC_16B_TFT) Interrupt Mask Register
+#define AT91C_TFT_LCDFRCFG (AT91_CAST(AT91_REG *) 	0x00500810) // (LCDC_16B_TFT) LCD Frame Config Register
+#define AT91C_TFT_CTRSTCON (AT91_CAST(AT91_REG *) 	0x00500840) // (LCDC_16B_TFT) Contrast Control Register
+#define AT91C_TFT_DP1_2 (AT91_CAST(AT91_REG *) 	0x0050081C) // (LCDC_16B_TFT) Dithering Pattern DP1_2 Register
+#define AT91C_TFT_FRMP2 (AT91_CAST(AT91_REG *) 	0x0050000C) // (LCDC_16B_TFT) DMA Frame Pointer Register 2
+#define AT91C_TFT_LCDCON1 (AT91_CAST(AT91_REG *) 	0x00500800) // (LCDC_16B_TFT) LCD Control 1 Register
+#define AT91C_TFT_DP4_5 (AT91_CAST(AT91_REG *) 	0x00500834) // (LCDC_16B_TFT) Dithering Pattern DP4_5 Register
+#define AT91C_TFT_FRMA2 (AT91_CAST(AT91_REG *) 	0x00500014) // (LCDC_16B_TFT) DMA Frame Address Register 2
+#define AT91C_TFT_BA1   (AT91_CAST(AT91_REG *) 	0x00500000) // (LCDC_16B_TFT) DMA Base Address Register 1
+#define AT91C_TFT_DMA2DCFG (AT91_CAST(AT91_REG *) 	0x00500020) // (LCDC_16B_TFT) DMA 2D addressing configuration
+#define AT91C_TFT_LUT_ENTRY (AT91_CAST(AT91_REG *) 	0x00500C00) // (LCDC_16B_TFT) LUT Entries Register
+#define AT91C_TFT_DP6_7 (AT91_CAST(AT91_REG *) 	0x00500838) // (LCDC_16B_TFT) Dithering Pattern DP6_7 Register
+#define AT91C_TFT_FRMCFG (AT91_CAST(AT91_REG *) 	0x00500018) // (LCDC_16B_TFT) DMA Frame Configuration Register
+#define AT91C_TFT_TIM2  (AT91_CAST(AT91_REG *) 	0x0050080C) // (LCDC_16B_TFT) LCD Timing Config 2 Register
+#define AT91C_TFT_DP3_5 (AT91_CAST(AT91_REG *) 	0x00500824) // (LCDC_16B_TFT) Dithering Pattern DP3_5 Register
+#define AT91C_TFT_FRMA1 (AT91_CAST(AT91_REG *) 	0x00500010) // (LCDC_16B_TFT) DMA Frame Address Register 1
+#define AT91C_TFT_IER   (AT91_CAST(AT91_REG *) 	0x00500848) // (LCDC_16B_TFT) Interrupt Enable Register
+#define AT91C_TFT_DP2_3 (AT91_CAST(AT91_REG *) 	0x00500828) // (LCDC_16B_TFT) Dithering Pattern DP2_3 Register
+#define AT91C_TFT_FIFO  (AT91_CAST(AT91_REG *) 	0x00500814) // (LCDC_16B_TFT) LCD FIFO Register
+#define AT91C_TFT_BA2   (AT91_CAST(AT91_REG *) 	0x00500004) // (LCDC_16B_TFT) DMA Base Address Register 2
+#define AT91C_TFT_LCDCON2 (AT91_CAST(AT91_REG *) 	0x00500804) // (LCDC_16B_TFT) LCD Control 2 Register
+#define AT91C_TFT_GPR   (AT91_CAST(AT91_REG *) 	0x0050085C) // (LCDC_16B_TFT) General Purpose Register
+// ========== Register definition for HDMA_CH_0 peripheral ========== 
+#define AT91C_HDMA_CH_0_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFEC5C) // (HDMA_CH_0) HDMA Reserved
+#define AT91C_HDMA_CH_0_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC40) // (HDMA_CH_0) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_0_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFEC58) // (HDMA_CH_0) HDMA Channel Destination Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_0_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFEC44) // (HDMA_CH_0) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_0_CFG (AT91_CAST(AT91_REG *) 	0xFFFFEC50) // (HDMA_CH_0) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_0_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFEC54) // (HDMA_CH_0) HDMA Channel Source Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_0_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC60) // (HDMA_CH_0) HDMA Reserved
+#define AT91C_HDMA_CH_0_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFEC48) // (HDMA_CH_0) HDMA Channel Control A Register
+#define AT91C_HDMA_CH_0_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFEC4C) // (HDMA_CH_0) HDMA Channel Control B Register
+#define AT91C_HDMA_CH_0_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC3C) // (HDMA_CH_0) HDMA Channel Source Address Register
+// ========== Register definition for HDMA_CH_1 peripheral ========== 
+#define AT91C_HDMA_CH_1_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC88) // (HDMA_CH_1) HDMA Reserved
+#define AT91C_HDMA_CH_1_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFEC80) // (HDMA_CH_1) HDMA Channel Destination Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_1_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFEC74) // (HDMA_CH_1) HDMA Channel Control B Register
+#define AT91C_HDMA_CH_1_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC64) // (HDMA_CH_1) HDMA Channel Source Address Register
+#define AT91C_HDMA_CH_1_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFEC84) // (HDMA_CH_1) HDMA Reserved
+#define AT91C_HDMA_CH_1_CFG (AT91_CAST(AT91_REG *) 	0xFFFFEC78) // (HDMA_CH_1) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_1_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFEC6C) // (HDMA_CH_1) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_1_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC68) // (HDMA_CH_1) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_1_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFEC70) // (HDMA_CH_1) HDMA Channel Control A Register
+#define AT91C_HDMA_CH_1_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFEC7C) // (HDMA_CH_1) HDMA Channel Source Picture in Picture Configuration Register
+// ========== Register definition for HDMA_CH_2 peripheral ========== 
+#define AT91C_HDMA_CH_2_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC8C) // (HDMA_CH_2) HDMA Channel Source Address Register
+#define AT91C_HDMA_CH_2_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFECAC) // (HDMA_CH_2) HDMA Reserved
+#define AT91C_HDMA_CH_2_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFECA8) // (HDMA_CH_2) HDMA Channel Destination Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_2_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFECA4) // (HDMA_CH_2) HDMA Channel Source Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_2_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFEC90) // (HDMA_CH_2) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_2_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFEC94) // (HDMA_CH_2) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_2_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFEC98) // (HDMA_CH_2) HDMA Channel Control A Register
+#define AT91C_HDMA_CH_2_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFECB0) // (HDMA_CH_2) HDMA Reserved
+#define AT91C_HDMA_CH_2_CFG (AT91_CAST(AT91_REG *) 	0xFFFFECA0) // (HDMA_CH_2) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_2_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFEC9C) // (HDMA_CH_2) HDMA Channel Control B Register
+// ========== Register definition for HDMA_CH_3 peripheral ========== 
+#define AT91C_HDMA_CH_3_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFECCC) // (HDMA_CH_3) HDMA Channel Source Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_3_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFECC0) // (HDMA_CH_3) HDMA Channel Control A Register
+#define AT91C_HDMA_CH_3_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFECD0) // (HDMA_CH_3) HDMA Channel Destination Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_3_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFECC4) // (HDMA_CH_3) HDMA Channel Control B Register
+#define AT91C_HDMA_CH_3_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFECD4) // (HDMA_CH_3) HDMA Reserved
+#define AT91C_HDMA_CH_3_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFECBC) // (HDMA_CH_3) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_3_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFECD8) // (HDMA_CH_3) HDMA Reserved
+#define AT91C_HDMA_CH_3_CFG (AT91_CAST(AT91_REG *) 	0xFFFFECC8) // (HDMA_CH_3) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_3_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFECB8) // (HDMA_CH_3) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_3_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFECB4) // (HDMA_CH_3) HDMA Channel Source Address Register
+// ========== Register definition for HDMA_CH_4 peripheral ========== 
+#define AT91C_HDMA_CH_4_CFG (AT91_CAST(AT91_REG *) 	0xFFFFECF0) // (HDMA_CH_4) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_4_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFECFC) // (HDMA_CH_4) HDMA Reserved
+#define AT91C_HDMA_CH_4_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFED00) // (HDMA_CH_4) HDMA Reserved
+#define AT91C_HDMA_CH_4_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFECE0) // (HDMA_CH_4) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_4_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFECE8) // (HDMA_CH_4) HDMA Channel Control A Register
+#define AT91C_HDMA_CH_4_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFECDC) // (HDMA_CH_4) HDMA Channel Source Address Register
+#define AT91C_HDMA_CH_4_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFECEC) // (HDMA_CH_4) HDMA Channel Control B Register
+#define AT91C_HDMA_CH_4_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFECE4) // (HDMA_CH_4) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_4_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFECF4) // (HDMA_CH_4) HDMA Channel Source Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_4_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFECF8) // (HDMA_CH_4) HDMA Channel Destination Picture in Picture Configuration Register
+// ========== Register definition for HDMA_CH_5 peripheral ========== 
+#define AT91C_HDMA_CH_5_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFED14) // (HDMA_CH_5) HDMA Channel Control B Register
+#define AT91C_HDMA_CH_5_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFED08) // (HDMA_CH_5) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_5_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFED1C) // (HDMA_CH_5) HDMA Channel Source Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_5_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFED0C) // (HDMA_CH_5) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_5_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFED20) // (HDMA_CH_5) HDMA Channel Destination Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_5_CFG (AT91_CAST(AT91_REG *) 	0xFFFFED18) // (HDMA_CH_5) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_5_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFED28) // (HDMA_CH_5) HDMA Reserved
+#define AT91C_HDMA_CH_5_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFED04) // (HDMA_CH_5) HDMA Channel Source Address Register
+#define AT91C_HDMA_CH_5_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFED24) // (HDMA_CH_5) HDMA Reserved
+#define AT91C_HDMA_CH_5_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFED10) // (HDMA_CH_5) HDMA Channel Control A Register
+// ========== Register definition for HDMA_CH_6 peripheral ========== 
+#define AT91C_HDMA_CH_6_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFED2C) // (HDMA_CH_6) HDMA Channel Source Address Register
+#define AT91C_HDMA_CH_6_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFED4C) // (HDMA_CH_6) HDMA Reserved
+#define AT91C_HDMA_CH_6_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFED50) // (HDMA_CH_6) HDMA Reserved
+#define AT91C_HDMA_CH_6_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFED44) // (HDMA_CH_6) HDMA Channel Source Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_6_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFED3C) // (HDMA_CH_6) HDMA Channel Control B Register
+#define AT91C_HDMA_CH_6_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFED34) // (HDMA_CH_6) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_6_CFG (AT91_CAST(AT91_REG *) 	0xFFFFED40) // (HDMA_CH_6) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_6_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFED48) // (HDMA_CH_6) HDMA Channel Destination Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_6_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFED30) // (HDMA_CH_6) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_6_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFED38) // (HDMA_CH_6) HDMA Channel Control A Register
+// ========== Register definition for HDMA_CH_7 peripheral ========== 
+#define AT91C_HDMA_CH_7_CADDR (AT91_CAST(AT91_REG *) 	0xFFFFED78) // (HDMA_CH_7) HDMA Reserved
+#define AT91C_HDMA_CH_7_CFG (AT91_CAST(AT91_REG *) 	0xFFFFED68) // (HDMA_CH_7) HDMA Channel Configuration Register
+#define AT91C_HDMA_CH_7_DADDR (AT91_CAST(AT91_REG *) 	0xFFFFED58) // (HDMA_CH_7) HDMA Channel Destination Address Register
+#define AT91C_HDMA_CH_7_CTRLB (AT91_CAST(AT91_REG *) 	0xFFFFED64) // (HDMA_CH_7) HDMA Channel Control B Register
+#define AT91C_HDMA_CH_7_DSCR (AT91_CAST(AT91_REG *) 	0xFFFFED5C) // (HDMA_CH_7) HDMA Channel Descriptor Address Register
+#define AT91C_HDMA_CH_7_DPIP (AT91_CAST(AT91_REG *) 	0xFFFFED70) // (HDMA_CH_7) HDMA Channel Destination Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_7_CTRLA (AT91_CAST(AT91_REG *) 	0xFFFFED60) // (HDMA_CH_7) HDMA Channel Control A Register
+#define AT91C_HDMA_CH_7_BDSCR (AT91_CAST(AT91_REG *) 	0xFFFFED74) // (HDMA_CH_7) HDMA Reserved
+#define AT91C_HDMA_CH_7_SPIP (AT91_CAST(AT91_REG *) 	0xFFFFED6C) // (HDMA_CH_7) HDMA Channel Source Picture in Picture Configuration Register
+#define AT91C_HDMA_CH_7_SADDR (AT91_CAST(AT91_REG *) 	0xFFFFED54) // (HDMA_CH_7) HDMA Channel Source Address Register
+// ========== Register definition for HDMA peripheral ========== 
+#define AT91C_HDMA_EBCIDR (AT91_CAST(AT91_REG *) 	0xFFFFEC1C) // (HDMA) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Interrupt Disable register
+#define AT91C_HDMA_LAST (AT91_CAST(AT91_REG *) 	0xFFFFEC10) // (HDMA) HDMA Software Last Transfer Flag Register
+#define AT91C_HDMA_SREQ (AT91_CAST(AT91_REG *) 	0xFFFFEC08) // (HDMA) HDMA Software Single Request Register
+#define AT91C_HDMA_RSVD0 (AT91_CAST(AT91_REG *) 	0xFFFFEC34) // (HDMA) HDMA Reserved
+#define AT91C_HDMA_EBCIER (AT91_CAST(AT91_REG *) 	0xFFFFEC18) // (HDMA) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Interrupt Enable register
+#define AT91C_HDMA_GCFG (AT91_CAST(AT91_REG *) 	0xFFFFEC00) // (HDMA) HDMA Global Configuration Register
+#define AT91C_HDMA_CHER (AT91_CAST(AT91_REG *) 	0xFFFFEC28) // (HDMA) HDMA Channel Handler Enable Register
+#define AT91C_HDMA_RSVD1 (AT91_CAST(AT91_REG *) 	0xFFFFEC38) // (HDMA) HDMA Reserved
+#define AT91C_HDMA_CHDR (AT91_CAST(AT91_REG *) 	0xFFFFEC2C) // (HDMA) HDMA Channel Handler Disable Register
+#define AT91C_HDMA_EBCIMR (AT91_CAST(AT91_REG *) 	0xFFFFEC20) // (HDMA) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Mask Register
+#define AT91C_HDMA_CREQ (AT91_CAST(AT91_REG *) 	0xFFFFEC0C) // (HDMA) HDMA Software Chunk Transfer Request Register
+#define AT91C_HDMA_SYNC (AT91_CAST(AT91_REG *) 	0xFFFFEC14) // (HDMA) HDMA Request Synchronization Register
+#define AT91C_HDMA_EN   (AT91_CAST(AT91_REG *) 	0xFFFFEC04) // (HDMA) HDMA Controller Enable Register
+#define AT91C_HDMA_EBCISR (AT91_CAST(AT91_REG *) 	0xFFFFEC24) // (HDMA) HDMA Error, Chained Buffer transfer completed and Buffer transfer completed Status Register
+#define AT91C_HDMA_CHSR (AT91_CAST(AT91_REG *) 	0xFFFFEC30) // (HDMA) HDMA Channel Handler Status Register
+// ========== Register definition for HECC peripheral ========== 
+#define AT91C_HECC_VR   (AT91_CAST(AT91_REG *) 	0xFFFFE2FC) // (HECC)  ECC Version register
+#define AT91C_HECC_SR   (AT91_CAST(AT91_REG *) 	0xFFFFE208) // (HECC)  ECC Status register
+#define AT91C_HECC_CR   (AT91_CAST(AT91_REG *) 	0xFFFFE200) // (HECC)  ECC reset register
+#define AT91C_HECC_NPR  (AT91_CAST(AT91_REG *) 	0xFFFFE210) // (HECC)  ECC Parity N register
+#define AT91C_HECC_PR   (AT91_CAST(AT91_REG *) 	0xFFFFE20C) // (HECC)  ECC Parity register
+#define AT91C_HECC_MR   (AT91_CAST(AT91_REG *) 	0xFFFFE204) // (HECC)  ECC Page size register
+// ========== Register definition for EMACB peripheral ========== 
+#define AT91C_EMACB_ALE (AT91_CAST(AT91_REG *) 	0xFFFBC054) // (EMACB) Alignment Error Register
+#define AT91C_EMACB_RRE (AT91_CAST(AT91_REG *) 	0xFFFBC06C) // (EMACB) Receive Ressource Error Register
+#define AT91C_EMACB_SA4H (AT91_CAST(AT91_REG *) 	0xFFFBC0B4) // (EMACB) Specific Address 4 Top, Last 2 bytes
+#define AT91C_EMACB_TPQ (AT91_CAST(AT91_REG *) 	0xFFFBC0BC) // (EMACB) Transmit Pause Quantum Register
+#define AT91C_EMACB_RJA (AT91_CAST(AT91_REG *) 	0xFFFBC07C) // (EMACB) Receive Jabbers Register
+#define AT91C_EMACB_SA2H (AT91_CAST(AT91_REG *) 	0xFFFBC0A4) // (EMACB) Specific Address 2 Top, Last 2 bytes
+#define AT91C_EMACB_TPF (AT91_CAST(AT91_REG *) 	0xFFFBC08C) // (EMACB) Transmitted Pause Frames Register
+#define AT91C_EMACB_ROV (AT91_CAST(AT91_REG *) 	0xFFFBC070) // (EMACB) Receive Overrun Errors Register
+#define AT91C_EMACB_SA4L (AT91_CAST(AT91_REG *) 	0xFFFBC0B0) // (EMACB) Specific Address 4 Bottom, First 4 bytes
+#define AT91C_EMACB_MAN (AT91_CAST(AT91_REG *) 	0xFFFBC034) // (EMACB) PHY Maintenance Register
+#define AT91C_EMACB_TID (AT91_CAST(AT91_REG *) 	0xFFFBC0B8) // (EMACB) Type ID Checking Register
+#define AT91C_EMACB_TBQP (AT91_CAST(AT91_REG *) 	0xFFFBC01C) // (EMACB) Transmit Buffer Queue Pointer
+#define AT91C_EMACB_SA3L (AT91_CAST(AT91_REG *) 	0xFFFBC0A8) // (EMACB) Specific Address 3 Bottom, First 4 bytes
+#define AT91C_EMACB_DTF (AT91_CAST(AT91_REG *) 	0xFFFBC058) // (EMACB) Deferred Transmission Frame Register
+#define AT91C_EMACB_PTR (AT91_CAST(AT91_REG *) 	0xFFFBC038) // (EMACB) Pause Time Register
+#define AT91C_EMACB_CSE (AT91_CAST(AT91_REG *) 	0xFFFBC068) // (EMACB) Carrier Sense Error Register
+#define AT91C_EMACB_ECOL (AT91_CAST(AT91_REG *) 	0xFFFBC060) // (EMACB) Excessive Collision Register
+#define AT91C_EMACB_STE (AT91_CAST(AT91_REG *) 	0xFFFBC084) // (EMACB) SQE Test Error Register
+#define AT91C_EMACB_MCF (AT91_CAST(AT91_REG *) 	0xFFFBC048) // (EMACB) Multiple Collision Frame Register
+#define AT91C_EMACB_IER (AT91_CAST(AT91_REG *) 	0xFFFBC028) // (EMACB) Interrupt Enable Register
+#define AT91C_EMACB_ELE (AT91_CAST(AT91_REG *) 	0xFFFBC078) // (EMACB) Excessive Length Errors Register
+#define AT91C_EMACB_USRIO (AT91_CAST(AT91_REG *) 	0xFFFBC0C0) // (EMACB) USER Input/Output Register
+#define AT91C_EMACB_PFR (AT91_CAST(AT91_REG *) 	0xFFFBC03C) // (EMACB) Pause Frames received Register
+#define AT91C_EMACB_FCSE (AT91_CAST(AT91_REG *) 	0xFFFBC050) // (EMACB) Frame Check Sequence Error Register
+#define AT91C_EMACB_SA1L (AT91_CAST(AT91_REG *) 	0xFFFBC098) // (EMACB) Specific Address 1 Bottom, First 4 bytes
+#define AT91C_EMACB_NCR (AT91_CAST(AT91_REG *) 	0xFFFBC000) // (EMACB) Network Control Register
+#define AT91C_EMACB_HRT (AT91_CAST(AT91_REG *) 	0xFFFBC094) // (EMACB) Hash Address Top[63:32]
+#define AT91C_EMACB_NCFGR (AT91_CAST(AT91_REG *) 	0xFFFBC004) // (EMACB) Network Configuration Register
+#define AT91C_EMACB_SCF (AT91_CAST(AT91_REG *) 	0xFFFBC044) // (EMACB) Single Collision Frame Register
+#define AT91C_EMACB_LCOL (AT91_CAST(AT91_REG *) 	0xFFFBC05C) // (EMACB) Late Collision Register
+#define AT91C_EMACB_SA3H (AT91_CAST(AT91_REG *) 	0xFFFBC0AC) // (EMACB) Specific Address 3 Top, Last 2 bytes
+#define AT91C_EMACB_HRB (AT91_CAST(AT91_REG *) 	0xFFFBC090) // (EMACB) Hash Address Bottom[31:0]
+#define AT91C_EMACB_ISR (AT91_CAST(AT91_REG *) 	0xFFFBC024) // (EMACB) Interrupt Status Register
+#define AT91C_EMACB_IMR (AT91_CAST(AT91_REG *) 	0xFFFBC030) // (EMACB) Interrupt Mask Register
+#define AT91C_EMACB_WOL (AT91_CAST(AT91_REG *) 	0xFFFBC0C4) // (EMACB) Wake On LAN Register
+#define AT91C_EMACB_USF (AT91_CAST(AT91_REG *) 	0xFFFBC080) // (EMACB) Undersize Frames Register
+#define AT91C_EMACB_TSR (AT91_CAST(AT91_REG *) 	0xFFFBC014) // (EMACB) Transmit Status Register
+#define AT91C_EMACB_FRO (AT91_CAST(AT91_REG *) 	0xFFFBC04C) // (EMACB) Frames Received OK Register
+#define AT91C_EMACB_IDR (AT91_CAST(AT91_REG *) 	0xFFFBC02C) // (EMACB) Interrupt Disable Register
+#define AT91C_EMACB_SA1H (AT91_CAST(AT91_REG *) 	0xFFFBC09C) // (EMACB) Specific Address 1 Top, Last 2 bytes
+#define AT91C_EMACB_RLE (AT91_CAST(AT91_REG *) 	0xFFFBC088) // (EMACB) Receive Length Field Mismatch Register
+#define AT91C_EMACB_TUND (AT91_CAST(AT91_REG *) 	0xFFFBC064) // (EMACB) Transmit Underrun Error Register
+#define AT91C_EMACB_RSR (AT91_CAST(AT91_REG *) 	0xFFFBC020) // (EMACB) Receive Status Register
+#define AT91C_EMACB_SA2L (AT91_CAST(AT91_REG *) 	0xFFFBC0A0) // (EMACB) Specific Address 2 Bottom, First 4 bytes
+#define AT91C_EMACB_FTO (AT91_CAST(AT91_REG *) 	0xFFFBC040) // (EMACB) Frames Transmitted OK Register
+#define AT91C_EMACB_RSE (AT91_CAST(AT91_REG *) 	0xFFFBC074) // (EMACB) Receive Symbol Errors Register
+#define AT91C_EMACB_NSR (AT91_CAST(AT91_REG *) 	0xFFFBC008) // (EMACB) Network Status Register
+#define AT91C_EMACB_RBQP (AT91_CAST(AT91_REG *) 	0xFFFBC018) // (EMACB) Receive Buffer Queue Pointer
+#define AT91C_EMACB_REV (AT91_CAST(AT91_REG *) 	0xFFFBC0FC) // (EMACB) Revision Register
+// ========== Register definition for ISI peripheral ========== 
+#define AT91C_ISI_DMACHDR (AT91_CAST(AT91_REG *) 	0xFFFB403C) // (ISI) DMA Channel Disable Register
+#define AT91C_ISI_IMR   (AT91_CAST(AT91_REG *) 	0xFFFB4034) // (ISI) Interrupt Mask Register
+#define AT91C_ISI_R2YSET1 (AT91_CAST(AT91_REG *) 	0xFFFB401C) // (ISI) Color Space Conversion RGB to YCrCb Register
+#define AT91C_ISI_PDECF (AT91_CAST(AT91_REG *) 	0xFFFB400C) // (ISI) Preview Decimation Factor Register
+#define AT91C_ISI_CFG2  (AT91_CAST(AT91_REG *) 	0xFFFB4004) // (ISI) Configuration Register 2
+#define AT91C_ISI_DMACCTRL (AT91_CAST(AT91_REG *) 	0xFFFB4054) // (ISI) DMA Codec Control Register
+#define AT91C_ISI_CTRL  (AT91_CAST(AT91_REG *) 	0xFFFB4024) // (ISI) Control Register
+#define AT91C_ISI_Y2RSET0 (AT91_CAST(AT91_REG *) 	0xFFFB4010) // (ISI) Color Space Conversion YCrCb to RGB Register
+#define AT91C_ISI_WPSR  (AT91_CAST(AT91_REG *) 	0xFFFB40E8) // (ISI) Write Protection Status Register
+#define AT91C_ISI_DMACHER (AT91_CAST(AT91_REG *) 	0xFFFB4038) // (ISI) DMA Channel Enable Register
+#define AT91C_ISI_DMACHSR (AT91_CAST(AT91_REG *) 	0xFFFB4040) // (ISI) DMA Channel Status Register
+#define AT91C_ISI_IDR   (AT91_CAST(AT91_REG *) 	0xFFFB4030) // (ISI) Interrupt Disable Register
+#define AT91C_ISI_VER   (AT91_CAST(AT91_REG *) 	0xFFFB40FC) // (ISI) Version Register
+#define AT91C_ISI_Y2RSET1 (AT91_CAST(AT91_REG *) 	0xFFFB4014) // (ISI) Color Space Conversion YCrCb to RGB Register
+#define AT91C_ISI_R2YSET2 (AT91_CAST(AT91_REG *) 	0xFFFB4020) // (ISI) Color Space Conversion RGB to YCrCb Register
+#define AT91C_ISI_SR    (AT91_CAST(AT91_REG *) 	0xFFFB4028) // (ISI) Status Register
+#define AT91C_ISI_DMACDSCR (AT91_CAST(AT91_REG *) 	0xFFFB4058) // (ISI) DMA Codec Descriptor Address Register
+#define AT91C_ISI_IER   (AT91_CAST(AT91_REG *) 	0xFFFB402C) // (ISI) Interrupt Enable Register
+#define AT91C_ISI_WPCR  (AT91_CAST(AT91_REG *) 	0xFFFB40E4) // (ISI) Write Protection Control Register
+#define AT91C_ISI_DMACADDR (AT91_CAST(AT91_REG *) 	0xFFFB4050) // (ISI) DMA Codec Base Address Register
+#define AT91C_ISI_CFG1  (AT91_CAST(AT91_REG *) 	0xFFFB4000) // (ISI) Configuration Register 1
+#define AT91C_ISI_R2YSET0 (AT91_CAST(AT91_REG *) 	0xFFFB4018) // (ISI) Color Space Conversion RGB to YCrCb Register
+#define AT91C_ISI_PSIZE (AT91_CAST(AT91_REG *) 	0xFFFB4008) // (ISI) Preview Size Register
+#define AT91C_ISI_DMAPDSCR (AT91_CAST(AT91_REG *) 	0xFFFB404C) // (ISI) DMA Preview Descriptor Address Register
+#define AT91C_ISI_DMAPADDR (AT91_CAST(AT91_REG *) 	0xFFFB4044) // (ISI) DMA Preview Base Address Register
+#define AT91C_ISI_DMAPCTRL (AT91_CAST(AT91_REG *) 	0xFFFB4048) // (ISI) DMA Preview Control Register
+// ========== Register definition for UHPHS_OHCI peripheral ========== 
+#define AT91C_OHCI_HcRhPortStatus (AT91_CAST(AT91_REG *) 	0x00700054) // (UHPHS_OHCI) Root Hub Port Status Register
+#define AT91C_OHCI_HcFmRemaining (AT91_CAST(AT91_REG *) 	0x00700038) // (UHPHS_OHCI) Bit time remaining in the current Frame
+#define AT91C_OHCI_HcInterruptEnable (AT91_CAST(AT91_REG *) 	0x00700010) // (UHPHS_OHCI) Interrupt Enable Register
+#define AT91C_OHCI_HcControl (AT91_CAST(AT91_REG *) 	0x00700004) // (UHPHS_OHCI) Operating modes for the Host Controller
+#define AT91C_OHCI_HcPeriodicStart (AT91_CAST(AT91_REG *) 	0x00700040) // (UHPHS_OHCI) Periodic Start
+#define AT91C_OHCI_HcInterruptStatus (AT91_CAST(AT91_REG *) 	0x0070000C) // (UHPHS_OHCI) Interrupt Status Register
+#define AT91C_OHCI_HcRhDescriptorB (AT91_CAST(AT91_REG *) 	0x0070004C) // (UHPHS_OHCI) Root Hub characteristics B
+#define AT91C_OHCI_HcInterruptDisable (AT91_CAST(AT91_REG *) 	0x00700014) // (UHPHS_OHCI) Interrupt Disable Register
+#define AT91C_OHCI_HcPeriodCurrentED (AT91_CAST(AT91_REG *) 	0x0070001C) // (UHPHS_OHCI) Current Isochronous or Interrupt Endpoint Descriptor
+#define AT91C_OHCI_HcRhDescriptorA (AT91_CAST(AT91_REG *) 	0x00700048) // (UHPHS_OHCI) Root Hub characteristics A
+#define AT91C_OHCI_HcRhStatus (AT91_CAST(AT91_REG *) 	0x00700050) // (UHPHS_OHCI) Root Hub Status register
+#define AT91C_OHCI_HcBulkCurrentED (AT91_CAST(AT91_REG *) 	0x0070002C) // (UHPHS_OHCI) Current endpoint of the Bulk list
+#define AT91C_OHCI_HcControlHeadED (AT91_CAST(AT91_REG *) 	0x00700020) // (UHPHS_OHCI) First Endpoint Descriptor of the Control list
+#define AT91C_OHCI_HcLSThreshold (AT91_CAST(AT91_REG *) 	0x00700044) // (UHPHS_OHCI) LS Threshold
+#define AT91C_OHCI_HcRevision (AT91_CAST(AT91_REG *) 	0x00700000) // (UHPHS_OHCI) Revision
+#define AT91C_OHCI_HcBulkDoneHead (AT91_CAST(AT91_REG *) 	0x00700030) // (UHPHS_OHCI) Last completed transfer descriptor
+#define AT91C_OHCI_HcFmNumber (AT91_CAST(AT91_REG *) 	0x0070003C) // (UHPHS_OHCI) Frame number
+#define AT91C_OHCI_HcFmInterval (AT91_CAST(AT91_REG *) 	0x00700034) // (UHPHS_OHCI) Bit time between 2 consecutive SOFs
+#define AT91C_OHCI_HcBulkHeadED (AT91_CAST(AT91_REG *) 	0x00700028) // (UHPHS_OHCI) First endpoint register of the Bulk list
+#define AT91C_OHCI_HcHCCA (AT91_CAST(AT91_REG *) 	0x00700018) // (UHPHS_OHCI) Pointer to the Host Controller Communication Area
+#define AT91C_OHCI_HcCommandStatus (AT91_CAST(AT91_REG *) 	0x00700008) // (UHPHS_OHCI) Command & status Register
+#define AT91C_OHCI_HcControlCurrentED (AT91_CAST(AT91_REG *) 	0x00700024) // (UHPHS_OHCI) Endpoint Control and Status Register
+// ========== Register definition for UHPHS_EHCI peripheral ========== 
+#define AT91C_EHCI_USBSTS (AT91_CAST(AT91_REG *) 	0x00800014) // (UHPHS_EHCI) 
+#define AT91C_EHCI_INSNREG03 (AT91_CAST(AT91_REG *) 	0x0080009C) // (UHPHS_EHCI) 
+#define AT91C_EHCI_INSNREG00 (AT91_CAST(AT91_REG *) 	0x00800090) // (UHPHS_EHCI) 
+#define AT91C_EHCI_HCSPPORTROUTE (AT91_CAST(AT91_REG *) 	0x0080000C) // (UHPHS_EHCI) 
+#define AT91C_EHCI_FRINDEX (AT91_CAST(AT91_REG *) 	0x0080001C) // (UHPHS_EHCI) 
+#define AT91C_EHCI_CONFIGFLAG (AT91_CAST(AT91_REG *) 	0x00800050) // (UHPHS_EHCI) 
+#define AT91C_EHCI_HCCPARAMS (AT91_CAST(AT91_REG *) 	0x00800008) // (UHPHS_EHCI) 
+#define AT91C_EHCI_USBINTR (AT91_CAST(AT91_REG *) 	0x00800018) // (UHPHS_EHCI) 
+#define AT91C_EHCI_PORTSC (AT91_CAST(AT91_REG *) 	0x00800054) // (UHPHS_EHCI) 
+#define AT91C_EHCI_CTRLDSSEGMENT (AT91_CAST(AT91_REG *) 	0x00800020) // (UHPHS_EHCI) 
+#define AT91C_EHCI_VERSION (AT91_CAST(AT91_REG *) 	0x00800000) // (UHPHS_EHCI) 
+#define AT91C_EHCI_USBCMD (AT91_CAST(AT91_REG *) 	0x00800010) // (UHPHS_EHCI) 
+#define AT91C_EHCI_INSNREG04 (AT91_CAST(AT91_REG *) 	0x008000A0) // (UHPHS_EHCI) 
+#define AT91C_EHCI_PERIODICLISTBASE (AT91_CAST(AT91_REG *) 	0x00800024) // (UHPHS_EHCI) 
+#define AT91C_EHCI_INSNREG01 (AT91_CAST(AT91_REG *) 	0x00800094) // (UHPHS_EHCI) 
+#define AT91C_EHCI_HCSPARAMS (AT91_CAST(AT91_REG *) 	0x00800004) // (UHPHS_EHCI) 
+#define AT91C_EHCI_INSNREG05 (AT91_CAST(AT91_REG *) 	0x008000A4) // (UHPHS_EHCI) 
+#define AT91C_EHCI_ASYNCLISTADDR (AT91_CAST(AT91_REG *) 	0x00800028) // (UHPHS_EHCI) 
+#define AT91C_EHCI_INSNREG02 (AT91_CAST(AT91_REG *) 	0x00800098) // (UHPHS_EHCI) 
+// ========== Register definition for TRNG peripheral ========== 
+#define AT91C_TRNG_IDR  (AT91_CAST(AT91_REG *) 	0xFFFCC014) // (TRNG) Interrupt Disable Register
+#define AT91C_TRNG_IER  (AT91_CAST(AT91_REG *) 	0xFFFCC010) // (TRNG) Interrupt Enable Register
+#define AT91C_TRNG_VERSION (AT91_CAST(AT91_REG *) 	0xFFFCC0FC) // (TRNG) TRNG Version Register
+#define AT91C_TRNG_ISR  (AT91_CAST(AT91_REG *) 	0xFFFCC01C) // (TRNG) Interrupt Status Register
+#define AT91C_TRNG_CR   (AT91_CAST(AT91_REG *) 	0xFFFCC000) // (TRNG) Control Register
+#define AT91C_TRNG_ODATA (AT91_CAST(AT91_REG *) 	0xFFFCC050) // (TRNG) Output Data Register
+#define AT91C_TRNG_IMR  (AT91_CAST(AT91_REG *) 	0xFFFCC018) // (TRNG) Interrupt Mask Register
+
+// *****************************************************************************
+//               PIO DEFINITIONS FOR AT91SAM9G45
+// *****************************************************************************
+#define AT91C_PIO_PA0        (1 <<  0) // Pin Controlled by PA0
+#define AT91C_PA0_MCI0_CK  (AT91C_PIO_PA0) //  
+#define AT91C_PA0_TCLK3    (AT91C_PIO_PA0) //  
+#define AT91C_PIO_PA1        (1 <<  1) // Pin Controlled by PA1
+#define AT91C_PA1_MCI0_CDA (AT91C_PIO_PA1) //  
+#define AT91C_PA1_TIOA3    (AT91C_PIO_PA1) //  
+#define AT91C_PIO_PA10       (1 << 10) // Pin Controlled by PA10
+#define AT91C_PA10_ETX0     (AT91C_PIO_PA10) //  Ethernet MAC Transmit Data 0
+#define AT91C_PIO_PA11       (1 << 11) // Pin Controlled by PA11
+#define AT91C_PA11_ETX1     (AT91C_PIO_PA11) //  Ethernet MAC Transmit Data 1
+#define AT91C_PIO_PA12       (1 << 12) // Pin Controlled by PA12
+#define AT91C_PA12_ERX0     (AT91C_PIO_PA12) //  Ethernet MAC Receive Data 0
+#define AT91C_PIO_PA13       (1 << 13) // Pin Controlled by PA13
+#define AT91C_PA13_ERX1     (AT91C_PIO_PA13) //  Ethernet MAC Receive Data 1
+#define AT91C_PIO_PA14       (1 << 14) // Pin Controlled by PA14
+#define AT91C_PA14_ETXEN    (AT91C_PIO_PA14) //  Ethernet MAC Transmit Enable
+#define AT91C_PIO_PA15       (1 << 15) // Pin Controlled by PA15
+#define AT91C_PA15_ERXDV    (AT91C_PIO_PA15) //  Ethernet MAC Receive Data Valid
+#define AT91C_PIO_PA16       (1 << 16) // Pin Controlled by PA16
+#define AT91C_PA16_ERXER    (AT91C_PIO_PA16) //  Ethernet MAC Receive Error
+#define AT91C_PIO_PA17       (1 << 17) // Pin Controlled by PA17
+#define AT91C_PA17_ETXCK_EREFCK (AT91C_PIO_PA17) //  Ethernet MAC Transmit Clock/Reference Clock
+#define AT91C_PIO_PA18       (1 << 18) // Pin Controlled by PA18
+#define AT91C_PA18_EMDC     (AT91C_PIO_PA18) //  Ethernet MAC Management Data Clock
+#define AT91C_PIO_PA19       (1 << 19) // Pin Controlled by PA19
+#define AT91C_PA19_EMDIO    (AT91C_PIO_PA19) //  Ethernet MAC Management Data Input/Output
+#define AT91C_PIO_PA2        (1 <<  2) // Pin Controlled by PA2
+#define AT91C_PA2_MCI0_DA0 (AT91C_PIO_PA2) //  
+#define AT91C_PA2_TIOB3    (AT91C_PIO_PA2) //  
+#define AT91C_PIO_PA20       (1 << 20) // Pin Controlled by PA20
+#define AT91C_PA20_TWD0     (AT91C_PIO_PA20) //  TWI Two-wire Serial Data
+#define AT91C_PIO_PA21       (1 << 21) // Pin Controlled by PA21
+#define AT91C_PA21_TWCK0    (AT91C_PIO_PA21) //  TWI Two-wire Serial Clock
+#define AT91C_PIO_PA22       (1 << 22) // Pin Controlled by PA22
+#define AT91C_PA22_MCI1_CDA (AT91C_PIO_PA22) //  
+#define AT91C_PA22_SCK3     (AT91C_PIO_PA22) //  
+#define AT91C_PIO_PA23       (1 << 23) // Pin Controlled by PA23
+#define AT91C_PA23_MCI1_DA0 (AT91C_PIO_PA23) //  
+#define AT91C_PA23_RTS3     (AT91C_PIO_PA23) //  
+#define AT91C_PIO_PA24       (1 << 24) // Pin Controlled by PA24
+#define AT91C_PA24_MCI1_DA1 (AT91C_PIO_PA24) //  
+#define AT91C_PA24_CTS3     (AT91C_PIO_PA24) //  
+#define AT91C_PIO_PA25       (1 << 25) // Pin Controlled by PA25
+#define AT91C_PA25_MCI1_DA2 (AT91C_PIO_PA25) //  
+#define AT91C_PA25_PWM3     (AT91C_PIO_PA25) //  
+#define AT91C_PIO_PA26       (1 << 26) // Pin Controlled by PA26
+#define AT91C_PA26_MCI1_DA3 (AT91C_PIO_PA26) //  
+#define AT91C_PA26_TIOB2    (AT91C_PIO_PA26) //  
+#define AT91C_PIO_PA27       (1 << 27) // Pin Controlled by PA27
+#define AT91C_PA27_MCI1_DA4 (AT91C_PIO_PA27) //  
+#define AT91C_PA27_ETXER    (AT91C_PIO_PA27) //  Ethernet MAC Transmikt Coding Error
+#define AT91C_PIO_PA28       (1 << 28) // Pin Controlled by PA28
+#define AT91C_PA28_MCI1_DA5 (AT91C_PIO_PA28) //  
+#define AT91C_PA28_ERXCK    (AT91C_PIO_PA28) //  Ethernet MAC Receive Clock
+#define AT91C_PIO_PA29       (1 << 29) // Pin Controlled by PA29
+#define AT91C_PA29_MCI1_DA6 (AT91C_PIO_PA29) //  
+#define AT91C_PA29_ECRS     (AT91C_PIO_PA29) //  Ethernet MAC Carrier Sense/Carrier Sense and Data Valid
+#define AT91C_PIO_PA3        (1 <<  3) // Pin Controlled by PA3
+#define AT91C_PA3_MCI0_DA1 (AT91C_PIO_PA3) //  
+#define AT91C_PA3_TCLK4    (AT91C_PIO_PA3) //  
+#define AT91C_PIO_PA30       (1 << 30) // Pin Controlled by PA30
+#define AT91C_PA30_MCI1_DA7 (AT91C_PIO_PA30) //  
+#define AT91C_PA30_ECOL     (AT91C_PIO_PA30) //  Ethernet MAC Collision Detected
+#define AT91C_PIO_PA31       (1 << 31) // Pin Controlled by PA31
+#define AT91C_PA31_MCI1_CK  (AT91C_PIO_PA31) //  
+#define AT91C_PA31_PCK0     (AT91C_PIO_PA31) //  
+#define AT91C_PIO_PA4        (1 <<  4) // Pin Controlled by PA4
+#define AT91C_PA4_MCI0_DA2 (AT91C_PIO_PA4) //  
+#define AT91C_PA4_TIOA4    (AT91C_PIO_PA4) //  
+#define AT91C_PIO_PA5        (1 <<  5) // Pin Controlled by PA5
+#define AT91C_PA5_MCI0_DA3 (AT91C_PIO_PA5) //  
+#define AT91C_PA5_TIOB4    (AT91C_PIO_PA5) //  
+#define AT91C_PIO_PA6        (1 <<  6) // Pin Controlled by PA6
+#define AT91C_PA6_MCI0_DA4 (AT91C_PIO_PA6) //  
+#define AT91C_PA6_ETX2     (AT91C_PIO_PA6) //  Ethernet MAC Transmit Data 2
+#define AT91C_PIO_PA7        (1 <<  7) // Pin Controlled by PA7
+#define AT91C_PA7_MCI0_DA5 (AT91C_PIO_PA7) //  
+#define AT91C_PA7_ETX3     (AT91C_PIO_PA7) //  Ethernet MAC Transmit Data 3
+#define AT91C_PIO_PA8        (1 <<  8) // Pin Controlled by PA8
+#define AT91C_PA8_MCI0_DA6 (AT91C_PIO_PA8) //  
+#define AT91C_PA8_ERX2     (AT91C_PIO_PA8) //  Ethernet MAC Receive Data 2
+#define AT91C_PIO_PA9        (1 <<  9) // Pin Controlled by PA9
+#define AT91C_PA9_MCI0_DA7 (AT91C_PIO_PA9) //  
+#define AT91C_PA9_ERX3     (AT91C_PIO_PA9) //  Ethernet MAC Receive Data 3
+#define AT91C_PIO_PB0        (1 <<  0) // Pin Controlled by PB0
+#define AT91C_PB0_SPI0_MISO (AT91C_PIO_PB0) //  SPI 0 Master In Slave
+#define AT91C_PIO_PB1        (1 <<  1) // Pin Controlled by PB1
+#define AT91C_PB1_SPI0_MOSI (AT91C_PIO_PB1) //  SPI 0 Master Out Slave
+#define AT91C_PIO_PB10       (1 << 10) // Pin Controlled by PB10
+#define AT91C_PB10_TWD1     (AT91C_PIO_PB10) //  
+#define AT91C_PB10_ISI_D10  (AT91C_PIO_PB10) //  
+#define AT91C_PIO_PB11       (1 << 11) // Pin Controlled by PB11
+#define AT91C_PB11_TWCK1    (AT91C_PIO_PB11) //  
+#define AT91C_PB11_ISI_D11  (AT91C_PIO_PB11) //  
+#define AT91C_PIO_PB12       (1 << 12) // Pin Controlled by PB12
+#define AT91C_PB12_DRXD     (AT91C_PIO_PB12) //  
+#define AT91C_PIO_PB13       (1 << 13) // Pin Controlled by PB13
+#define AT91C_PB13_DTXD     (AT91C_PIO_PB13) //  
+#define AT91C_PIO_PB14       (1 << 14) // Pin Controlled by PB14
+#define AT91C_PB14_SPI1_MISO (AT91C_PIO_PB14) //  
+#define AT91C_PIO_PB15       (1 << 15) // Pin Controlled by PB15
+#define AT91C_PB15_SPI1_MOSI (AT91C_PIO_PB15) //  
+#define AT91C_PB15_CTS0     (AT91C_PIO_PB15) //  
+#define AT91C_PIO_PB16       (1 << 16) // Pin Controlled by PB16
+#define AT91C_PB16_SPI1_SPCK (AT91C_PIO_PB16) //  
+#define AT91C_PB16_SCK0     (AT91C_PIO_PB16) //  
+#define AT91C_PIO_PB17       (1 << 17) // Pin Controlled by PB17
+#define AT91C_PB17_SPI1_NPCS0 (AT91C_PIO_PB17) //  
+#define AT91C_PB17_RTS0     (AT91C_PIO_PB17) //  
+#define AT91C_PIO_PB18       (1 << 18) // Pin Controlled by PB18
+#define AT91C_PB18_RXD0     (AT91C_PIO_PB18) //  
+#define AT91C_PB18_SPI0_NPCS1 (AT91C_PIO_PB18) //  
+#define AT91C_PIO_PB19       (1 << 19) // Pin Controlled by PB19
+#define AT91C_PB19_TXD0     (AT91C_PIO_PB19) //  
+#define AT91C_PB19_SPI0_NPCS2 (AT91C_PIO_PB19) //  
+#define AT91C_PIO_PB2        (1 <<  2) // Pin Controlled by PB2
+#define AT91C_PB2_SPI0_SPCK (AT91C_PIO_PB2) //  SPI 0 Serial Clock
+#define AT91C_PIO_PB20       (1 << 20) // Pin Controlled by PB20
+#define AT91C_PB20_ISI_D0   (AT91C_PIO_PB20) //  
+#define AT91C_PIO_PB21       (1 << 21) // Pin Controlled by PB21
+#define AT91C_PB21_ISI_D1   (AT91C_PIO_PB21) //  
+#define AT91C_PIO_PB22       (1 << 22) // Pin Controlled by PB22
+#define AT91C_PB22_ISI_D2   (AT91C_PIO_PB22) //  
+#define AT91C_PIO_PB23       (1 << 23) // Pin Controlled by PB23
+#define AT91C_PB23_ISI_D3   (AT91C_PIO_PB23) //  
+#define AT91C_PIO_PB24       (1 << 24) // Pin Controlled by PB24
+#define AT91C_PB24_ISI_D4   (AT91C_PIO_PB24) //  
+#define AT91C_PIO_PB25       (1 << 25) // Pin Controlled by PB25
+#define AT91C_PB25_ISI_D5   (AT91C_PIO_PB25) //  
+#define AT91C_PIO_PB26       (1 << 26) // Pin Controlled by PB26
+#define AT91C_PB26_ISI_D6   (AT91C_PIO_PB26) //  
+#define AT91C_PIO_PB27       (1 << 27) // Pin Controlled by PB27
+#define AT91C_PB27_ISI_D7   (AT91C_PIO_PB27) //  
+#define AT91C_PIO_PB28       (1 << 28) // Pin Controlled by PB28
+#define AT91C_PB28_ISI_PCK  (AT91C_PIO_PB28) //  
+#define AT91C_PIO_PB29       (1 << 29) // Pin Controlled by PB29
+#define AT91C_PB29_ISI_VSYNC (AT91C_PIO_PB29) //  
+#define AT91C_PIO_PB3        (1 <<  3) // Pin Controlled by PB3
+#define AT91C_PB3_SPI0_NPCS0 (AT91C_PIO_PB3) //  SPI 0 Peripheral Chip Select 0
+#define AT91C_PIO_PB30       (1 << 30) // Pin Controlled by PB30
+#define AT91C_PB30_ISI_HSYNC (AT91C_PIO_PB30) //  
+#define AT91C_PIO_PB31       (1 << 31) // Pin Controlled by PB31
+#define AT91C_PB31_         (AT91C_PIO_PB31) //  
+#define AT91C_PB31_PCK1     (AT91C_PIO_PB31) //  
+#define AT91C_PIO_PB4        (1 <<  4) // Pin Controlled by PB4
+#define AT91C_PB4_TXD1     (AT91C_PIO_PB4) //  USART 1 Transmit Data
+#define AT91C_PIO_PB5        (1 <<  5) // Pin Controlled by PB5
+#define AT91C_PB5_RXD1     (AT91C_PIO_PB5) //  USART 1 Receive Data
+#define AT91C_PIO_PB6        (1 <<  6) // Pin Controlled by PB6
+#define AT91C_PB6_TXD2     (AT91C_PIO_PB6) //  USART 2 Transmit Data
+#define AT91C_PIO_PB7        (1 <<  7) // Pin Controlled by PB7
+#define AT91C_PB7_RXD2     (AT91C_PIO_PB7) //  USART 2 Receive Data
+#define AT91C_PIO_PB8        (1 <<  8) // Pin Controlled by PB8
+#define AT91C_PB8_TXD3     (AT91C_PIO_PB8) //  USART 3 Transmit Data
+#define AT91C_PB8_ISI_D8   (AT91C_PIO_PB8) //  
+#define AT91C_PIO_PB9        (1 <<  9) // Pin Controlled by PB9
+#define AT91C_PB9_RXD3     (AT91C_PIO_PB9) //  USART 3 Receive Data
+#define AT91C_PB9_ISI_D9   (AT91C_PIO_PB9) //  
+#define AT91C_PIO_PC0        (1 <<  0) // Pin Controlled by PC0
+#define AT91C_PC0_DQM2     (AT91C_PIO_PC0) //  DQM2
+#define AT91C_PIO_PC1        (1 <<  1) // Pin Controlled by PC1
+#define AT91C_PC1_DQM3     (AT91C_PIO_PC1) //  DQM3
+#define AT91C_PIO_PC10       (1 << 10) // Pin Controlled by PC10
+#define AT91C_PC10_NCS4_CFCS0 (AT91C_PIO_PC10) //  
+#define AT91C_PC10_TCLK2    (AT91C_PIO_PC10) //  
+#define AT91C_PIO_PC11       (1 << 11) // Pin Controlled by PC11
+#define AT91C_PC11_NCS5_CFCS1 (AT91C_PIO_PC11) //  
+#define AT91C_PC11_CTS2     (AT91C_PIO_PC11) //  
+#define AT91C_PIO_PC12       (1 << 12) // Pin Controlled by PC12
+#define AT91C_PC12_A25_CFRNW (AT91C_PIO_PC12) //  
+#define AT91C_PIO_PC13       (1 << 13) // Pin Controlled by PC13
+#define AT91C_PC13_NCS2     (AT91C_PIO_PC13) //  
+#define AT91C_PIO_PC14       (1 << 14) // Pin Controlled by PC14
+#define AT91C_PC14_NCS3_NANDCS (AT91C_PIO_PC14) //  
+#define AT91C_PIO_PC15       (1 << 15) // Pin Controlled by PC15
+#define AT91C_PC15_NWAIT    (AT91C_PIO_PC15) //  
+#define AT91C_PIO_PC16       (1 << 16) // Pin Controlled by PC16
+#define AT91C_PC16_D16      (AT91C_PIO_PC16) //  
+#define AT91C_PIO_PC17       (1 << 17) // Pin Controlled by PC17
+#define AT91C_PC17_D17      (AT91C_PIO_PC17) //  
+#define AT91C_PIO_PC18       (1 << 18) // Pin Controlled by PC18
+#define AT91C_PC18_D18      (AT91C_PIO_PC18) //  
+#define AT91C_PIO_PC19       (1 << 19) // Pin Controlled by PC19
+#define AT91C_PC19_D19      (AT91C_PIO_PC19) //  
+#define AT91C_PIO_PC2        (1 <<  2) // Pin Controlled by PC2
+#define AT91C_PC2_A19      (AT91C_PIO_PC2) //  
+#define AT91C_PIO_PC20       (1 << 20) // Pin Controlled by PC20
+#define AT91C_PC20_D20      (AT91C_PIO_PC20) //  
+#define AT91C_PIO_PC21       (1 << 21) // Pin Controlled by PC21
+#define AT91C_PC21_D21      (AT91C_PIO_PC21) //  
+#define AT91C_PIO_PC22       (1 << 22) // Pin Controlled by PC22
+#define AT91C_PC22_D22      (AT91C_PIO_PC22) //  
+#define AT91C_PIO_PC23       (1 << 23) // Pin Controlled by PC23
+#define AT91C_PC23_D23      (AT91C_PIO_PC23) //  
+#define AT91C_PIO_PC24       (1 << 24) // Pin Controlled by PC24
+#define AT91C_PC24_D24      (AT91C_PIO_PC24) //  
+#define AT91C_PIO_PC25       (1 << 25) // Pin Controlled by PC25
+#define AT91C_PC25_D25      (AT91C_PIO_PC25) //  
+#define AT91C_PIO_PC26       (1 << 26) // Pin Controlled by PC26
+#define AT91C_PC26_D26      (AT91C_PIO_PC26) //  
+#define AT91C_PIO_PC27       (1 << 27) // Pin Controlled by PC27
+#define AT91C_PC27_D27      (AT91C_PIO_PC27) //  
+#define AT91C_PIO_PC28       (1 << 28) // Pin Controlled by PC28
+#define AT91C_PC28_D28      (AT91C_PIO_PC28) //  
+#define AT91C_PIO_PC29       (1 << 29) // Pin Controlled by PC29
+#define AT91C_PC29_D29      (AT91C_PIO_PC29) //  
+#define AT91C_PIO_PC3        (1 <<  3) // Pin Controlled by PC3
+#define AT91C_PC3_A20      (AT91C_PIO_PC3) //  
+#define AT91C_PIO_PC30       (1 << 30) // Pin Controlled by PC30
+#define AT91C_PC30_D30      (AT91C_PIO_PC30) //  
+#define AT91C_PIO_PC31       (1 << 31) // Pin Controlled by PC31
+#define AT91C_PC31_D31      (AT91C_PIO_PC31) //  
+#define AT91C_PIO_PC4        (1 <<  4) // Pin Controlled by PC4
+#define AT91C_PC4_A21_NANDALE (AT91C_PIO_PC4) //  
+#define AT91C_PIO_PC5        (1 <<  5) // Pin Controlled by PC5
+#define AT91C_PC5_A22_NANDCLE (AT91C_PIO_PC5) //  
+#define AT91C_PIO_PC6        (1 <<  6) // Pin Controlled by PC6
+#define AT91C_PC6_A23      (AT91C_PIO_PC6) //  
+#define AT91C_PIO_PC7        (1 <<  7) // Pin Controlled by PC7
+#define AT91C_PC7_A24      (AT91C_PIO_PC7) //  
+#define AT91C_PIO_PC8        (1 <<  8) // Pin Controlled by PC8
+#define AT91C_PC8_CFCE1    (AT91C_PIO_PC8) //  
+#define AT91C_PIO_PC9        (1 <<  9) // Pin Controlled by PC9
+#define AT91C_PC9_CFCE2    (AT91C_PIO_PC9) //  
+#define AT91C_PC9_RTS2     (AT91C_PIO_PC9) //  
+#define AT91C_PIO_PD0        (1 <<  0) // Pin Controlled by PD0
+#define AT91C_PD0_TK0      (AT91C_PIO_PD0) //  
+#define AT91C_PD0_PWM3     (AT91C_PIO_PD0) //  
+#define AT91C_PIO_PD1        (1 <<  1) // Pin Controlled by PD1
+#define AT91C_PD1_TF0      (AT91C_PIO_PD1) //  
+#define AT91C_PIO_PD10       (1 << 10) // Pin Controlled by PD10
+#define AT91C_PD10_TD1      (AT91C_PIO_PD10) //  
+#define AT91C_PIO_PD11       (1 << 11) // Pin Controlled by PD11
+#define AT91C_PD11_RD1      (AT91C_PIO_PD11) //  
+#define AT91C_PIO_PD12       (1 << 12) // Pin Controlled by PD12
+#define AT91C_PD12_TK1      (AT91C_PIO_PD12) //  
+#define AT91C_PD12_PCK0     (AT91C_PIO_PD12) //  
+#define AT91C_PIO_PD13       (1 << 13) // Pin Controlled by PD13
+#define AT91C_PD13_RK1      (AT91C_PIO_PD13) //  
+#define AT91C_PIO_PD14       (1 << 14) // Pin Controlled by PD14
+#define AT91C_PD14_TF1      (AT91C_PIO_PD14) //  
+#define AT91C_PIO_PD15       (1 << 15) // Pin Controlled by PD15
+#define AT91C_PD15_RF1      (AT91C_PIO_PD15) //  
+#define AT91C_PIO_PD16       (1 << 16) // Pin Controlled by PD16
+#define AT91C_PD16_RTS1     (AT91C_PIO_PD16) //  
+#define AT91C_PIO_PD17       (1 << 17) // Pin Controlled by PD17
+#define AT91C_PD17_CTS1     (AT91C_PIO_PD17) //  
+#define AT91C_PIO_PD18       (1 << 18) // Pin Controlled by PD18
+#define AT91C_PD18_SPI1_NPCS2 (AT91C_PIO_PD18) //  
+#define AT91C_PD18_IRQ      (AT91C_PIO_PD18) //  
+#define AT91C_PIO_PD19       (1 << 19) // Pin Controlled by PD19
+#define AT91C_PD19_SPI1_NPCS3 (AT91C_PIO_PD19) //  
+#define AT91C_PD19_FIQ      (AT91C_PIO_PD19) //  
+#define AT91C_PIO_PD2        (1 <<  2) // Pin Controlled by PD2
+#define AT91C_PD2_TD0      (AT91C_PIO_PD2) //  
+#define AT91C_PIO_PD20       (1 << 20) // Pin Controlled by PD20
+#define AT91C_PD20_TIOA0    (AT91C_PIO_PD20) //  
+#define AT91C_PIO_PD21       (1 << 21) // Pin Controlled by PD21
+#define AT91C_PD21_TIOA1    (AT91C_PIO_PD21) //  
+#define AT91C_PIO_PD22       (1 << 22) // Pin Controlled by PD22
+#define AT91C_PD22_TIOA2    (AT91C_PIO_PD22) //  
+#define AT91C_PIO_PD23       (1 << 23) // Pin Controlled by PD23
+#define AT91C_PD23_TCLK0    (AT91C_PIO_PD23) //  
+#define AT91C_PIO_PD24       (1 << 24) // Pin Controlled by PD24
+#define AT91C_PD24_SPI0_NPCS1 (AT91C_PIO_PD24) //  
+#define AT91C_PD24_PWM0     (AT91C_PIO_PD24) //  
+#define AT91C_PIO_PD25       (1 << 25) // Pin Controlled by PD25
+#define AT91C_PD25_SPI0_NPCS2 (AT91C_PIO_PD25) //  
+#define AT91C_PD25_PWM1     (AT91C_PIO_PD25) //  
+#define AT91C_PIO_PD26       (1 << 26) // Pin Controlled by PD26
+#define AT91C_PD26_PCK0     (AT91C_PIO_PD26) //  
+#define AT91C_PD26_PWM2     (AT91C_PIO_PD26) //  
+#define AT91C_PIO_PD27       (1 << 27) // Pin Controlled by PD27
+#define AT91C_PD27_PCK1     (AT91C_PIO_PD27) //  
+#define AT91C_PD27_SPI0_NPCS3 (AT91C_PIO_PD27) //  
+#define AT91C_PIO_PD28       (1 << 28) // Pin Controlled by PD28
+#define AT91C_PD28_TSADTRG  (AT91C_PIO_PD28) //  
+#define AT91C_PD28_SPI1_NPCS1 (AT91C_PIO_PD28) //  
+#define AT91C_PIO_PD29       (1 << 29) // Pin Controlled by PD29
+#define AT91C_PD29_TCLK1    (AT91C_PIO_PD29) //  
+#define AT91C_PD29_SCK1     (AT91C_PIO_PD29) //  
+#define AT91C_PIO_PD3        (1 <<  3) // Pin Controlled by PD3
+#define AT91C_PD3_RD0      (AT91C_PIO_PD3) //  
+#define AT91C_PIO_PD30       (1 << 30) // Pin Controlled by PD30
+#define AT91C_PD30_TIOB0    (AT91C_PIO_PD30) //  
+#define AT91C_PD30_SCK2     (AT91C_PIO_PD30) //  
+#define AT91C_PIO_PD31       (1 << 31) // Pin Controlled by PD31
+#define AT91C_PD31_TIOB1    (AT91C_PIO_PD31) //  
+#define AT91C_PD31_PWM1     (AT91C_PIO_PD31) //  
+#define AT91C_PIO_PD4        (1 <<  4) // Pin Controlled by PD4
+#define AT91C_PD4_RK0      (AT91C_PIO_PD4) //  
+#define AT91C_PIO_PD5        (1 <<  5) // Pin Controlled by PD5
+#define AT91C_PD5_RF0      (AT91C_PIO_PD5) //  
+#define AT91C_PIO_PD6        (1 <<  6) // Pin Controlled by PD6
+#define AT91C_PD6_AC97RX   (AT91C_PIO_PD6) //  
+#define AT91C_PIO_PD7        (1 <<  7) // Pin Controlled by PD7
+#define AT91C_PD7_AC97TX   (AT91C_PIO_PD7) //  
+#define AT91C_PD7_TIOA5    (AT91C_PIO_PD7) //  
+#define AT91C_PIO_PD8        (1 <<  8) // Pin Controlled by PD8
+#define AT91C_PD8_AC97FS   (AT91C_PIO_PD8) //  
+#define AT91C_PD8_TIOB5    (AT91C_PIO_PD8) //  
+#define AT91C_PIO_PD9        (1 <<  9) // Pin Controlled by PD9
+#define AT91C_PD9_AC97CK   (AT91C_PIO_PD9) //  
+#define AT91C_PD9_TCLK5    (AT91C_PIO_PD9) //  
+#define AT91C_PIO_PE0        (1 <<  0) // Pin Controlled by PE0
+#define AT91C_PE0_LCDPWR   (AT91C_PIO_PE0) //  
+#define AT91C_PE0_PCK0     (AT91C_PIO_PE0) //  
+#define AT91C_PIO_PE1        (1 <<  1) // Pin Controlled by PE1
+#define AT91C_PE1_LCDMOD   (AT91C_PIO_PE1) //  
+#define AT91C_PIO_PE10       (1 << 10) // Pin Controlled by PE10
+#define AT91C_PE10_LCDD3    (AT91C_PIO_PE10) //  
+#define AT91C_PE10_LCDD5    (AT91C_PIO_PE10) //  
+#define AT91C_PIO_PE11       (1 << 11) // Pin Controlled by PE11
+#define AT91C_PE11_LCDD4    (AT91C_PIO_PE11) //  
+#define AT91C_PE11_LCDD6    (AT91C_PIO_PE11) //  
+#define AT91C_PIO_PE12       (1 << 12) // Pin Controlled by PE12
+#define AT91C_PE12_LCDD5    (AT91C_PIO_PE12) //  
+#define AT91C_PE12_LCDD7    (AT91C_PIO_PE12) //  
+#define AT91C_PIO_PE13       (1 << 13) // Pin Controlled by PE13
+#define AT91C_PE13_LCDD6    (AT91C_PIO_PE13) //  
+#define AT91C_PE13_LCDD10   (AT91C_PIO_PE13) //  
+#define AT91C_PIO_PE14       (1 << 14) // Pin Controlled by PE14
+#define AT91C_PE14_LCDD7    (AT91C_PIO_PE14) //  
+#define AT91C_PE14_LCDD11   (AT91C_PIO_PE14) //  
+#define AT91C_PIO_PE15       (1 << 15) // Pin Controlled by PE15
+#define AT91C_PE15_LCDD8    (AT91C_PIO_PE15) //  
+#define AT91C_PE15_LCDD12   (AT91C_PIO_PE15) //  
+#define AT91C_PIO_PE16       (1 << 16) // Pin Controlled by PE16
+#define AT91C_PE16_LCDD9    (AT91C_PIO_PE16) //  
+#define AT91C_PE16_LCDD13   (AT91C_PIO_PE16) //  
+#define AT91C_PIO_PE17       (1 << 17) // Pin Controlled by PE17
+#define AT91C_PE17_LCDD10   (AT91C_PIO_PE17) //  
+#define AT91C_PE17_LCDD14   (AT91C_PIO_PE17) //  
+#define AT91C_PIO_PE18       (1 << 18) // Pin Controlled by PE18
+#define AT91C_PE18_LCDD11   (AT91C_PIO_PE18) //  
+#define AT91C_PE18_LCDD15   (AT91C_PIO_PE18) //  
+#define AT91C_PIO_PE19       (1 << 19) // Pin Controlled by PE19
+#define AT91C_PE19_LCDD12   (AT91C_PIO_PE19) //  
+#define AT91C_PE19_LCDD18   (AT91C_PIO_PE19) //  
+#define AT91C_PIO_PE2        (1 <<  2) // Pin Controlled by PE2
+#define AT91C_PE2_LCDCC    (AT91C_PIO_PE2) //  
+#define AT91C_PIO_PE20       (1 << 20) // Pin Controlled by PE20
+#define AT91C_PE20_LCDD13   (AT91C_PIO_PE20) //  
+#define AT91C_PE20_LCDD19   (AT91C_PIO_PE20) //  
+#define AT91C_PIO_PE21       (1 << 21) // Pin Controlled by PE21
+#define AT91C_PE21_LCDD14   (AT91C_PIO_PE21) //  
+#define AT91C_PE21_LCDD20   (AT91C_PIO_PE21) //  
+#define AT91C_PIO_PE22       (1 << 22) // Pin Controlled by PE22
+#define AT91C_PE22_LCDD15   (AT91C_PIO_PE22) //  
+#define AT91C_PE22_LCDD21   (AT91C_PIO_PE22) //  
+#define AT91C_PIO_PE23       (1 << 23) // Pin Controlled by PE23
+#define AT91C_PE23_LCDD16   (AT91C_PIO_PE23) //  
+#define AT91C_PE23_LCDD22   (AT91C_PIO_PE23) //  
+#define AT91C_PIO_PE24       (1 << 24) // Pin Controlled by PE24
+#define AT91C_PE24_LCDD17   (AT91C_PIO_PE24) //  
+#define AT91C_PE24_LCDD23   (AT91C_PIO_PE24) //  
+#define AT91C_PIO_PE25       (1 << 25) // Pin Controlled by PE25
+#define AT91C_PE25_LCDD18   (AT91C_PIO_PE25) //  
+#define AT91C_PIO_PE26       (1 << 26) // Pin Controlled by PE26
+#define AT91C_PE26_LCDD19   (AT91C_PIO_PE26) //  
+#define AT91C_PIO_PE27       (1 << 27) // Pin Controlled by PE27
+#define AT91C_PE27_LCDD20   (AT91C_PIO_PE27) //  
+#define AT91C_PIO_PE28       (1 << 28) // Pin Controlled by PE28
+#define AT91C_PE28_LCDD21   (AT91C_PIO_PE28) //  
+#define AT91C_PIO_PE29       (1 << 29) // Pin Controlled by PE29
+#define AT91C_PE29_LCDD22   (AT91C_PIO_PE29) //  
+#define AT91C_PIO_PE3        (1 <<  3) // Pin Controlled by PE3
+#define AT91C_PE3_LCDVSYNC (AT91C_PIO_PE3) //  
+#define AT91C_PIO_PE30       (1 << 30) // Pin Controlled by PE30
+#define AT91C_PE30_LCDD23   (AT91C_PIO_PE30) //  
+#define AT91C_PIO_PE31       (1 << 31) // Pin Controlled by PE31
+#define AT91C_PE31_PWM2     (AT91C_PIO_PE31) //  
+#define AT91C_PE31_PCK1     (AT91C_PIO_PE31) //  
+#define AT91C_PIO_PE4        (1 <<  4) // Pin Controlled by PE4
+#define AT91C_PE4_LCDHSYNC (AT91C_PIO_PE4) //  
+#define AT91C_PIO_PE5        (1 <<  5) // Pin Controlled by PE5
+#define AT91C_PE5_LCDDOTCK (AT91C_PIO_PE5) //  
+#define AT91C_PIO_PE6        (1 <<  6) // Pin Controlled by PE6
+#define AT91C_PE6_LCDDEN   (AT91C_PIO_PE6) //  
+#define AT91C_PIO_PE7        (1 <<  7) // Pin Controlled by PE7
+#define AT91C_PE7_LCDD0    (AT91C_PIO_PE7) //  
+#define AT91C_PE7_LCDD2    (AT91C_PIO_PE7) //  
+#define AT91C_PIO_PE8        (1 <<  8) // Pin Controlled by PE8
+#define AT91C_PE8_LCDD1    (AT91C_PIO_PE8) //  
+#define AT91C_PE8_LCDD3    (AT91C_PIO_PE8) //  
+#define AT91C_PIO_PE9        (1 <<  9) // Pin Controlled by PE9
+#define AT91C_PE9_LCDD2    (AT91C_PIO_PE9) //  
+#define AT91C_PE9_LCDD4    (AT91C_PIO_PE9) //  
+
+// *****************************************************************************
+//               PERIPHERAL ID DEFINITIONS FOR AT91SAM9G45
+// *****************************************************************************
+#define AT91C_ID_FIQ    ( 0) // Advanced Interrupt Controller (FIQ)
+#define AT91C_ID_SYS    ( 1) // System Controller
+#define AT91C_ID_PIOA   ( 2) // Parallel IO Controller A
+#define AT91C_ID_PIOB   ( 3) // Parallel IO Controller B
+#define AT91C_ID_PIOC   ( 4) // Parallel IO Controller C
+#define AT91C_ID_PIOD_E ( 5) // Parallel IO Controller D and E
+#define AT91C_ID_TRNG   ( 6) // True Random Number Generator
+#define AT91C_ID_US0    ( 7) // USART 0
+#define AT91C_ID_US1    ( 8) // USART 1
+#define AT91C_ID_US2    ( 9) // USART 2
+#define AT91C_ID_US3    (10) // USART 2
+#define AT91C_ID_MCI0   (11) // Multimedia Card Interface 0
+#define AT91C_ID_TWI0   (12) // TWI 0
+#define AT91C_ID_TWI1   (13) // TWI 1
+#define AT91C_ID_SPI0   (14) // Serial Peripheral Interface
+#define AT91C_ID_SPI1   (15) // Serial Peripheral Interface
+#define AT91C_ID_SSC0   (16) // Serial Synchronous Controller 0
+#define AT91C_ID_SSC1   (17) // Serial Synchronous Controller 1
+#define AT91C_ID_TC     (18) // Timer Counter 0, 1, 2, 3, 4, 5
+#define AT91C_ID_PWMC   (19) // Pulse Width Modulation Controller
+#define AT91C_ID_TSADC  (20) // Touch Screen Controller
+#define AT91C_ID_HDMA   (21) // HDMA
+#define AT91C_ID_UHPHS  (22) // USB Host High Speed
+#define AT91C_ID_LCDC   (23) // LCD Controller
+#define AT91C_ID_AC97C  (24) // AC97 Controller
+#define AT91C_ID_EMAC   (25) // Ethernet MAC
+#define AT91C_ID_ISI    (26) // Image Sensor Interface
+#define AT91C_ID_UDPHS  (27) // USB Device HS
+#define AT91C_ID_MCI1   (29) // Multimedia Card Interface 1
+#define AT91C_ID_VDEC   (30) // Video Decoder
+#define AT91C_ID_IRQ0   (31) // Advanced Interrupt Controller (IRQ0)
+#define AT91C_ALL_INT   (0xEFFFFFFF) // ALL VALID INTERRUPTS
+
+// *****************************************************************************
+//               BASE ADDRESS DEFINITIONS FOR AT91SAM9G45
+// *****************************************************************************
+#define AT91C_BASE_SFR       (AT91_CAST(AT91PS_SFR) 	0xFFF74000) // (SFR) Base Address
+#define AT91C_BASE_SYS       (AT91_CAST(AT91PS_SYS) 	0xFFFFC000) // (SYS) Base Address
+#define AT91C_BASE_EBI       (AT91_CAST(AT91PS_EBI) 	0xFFFFE200) // (EBI) Base Address
+#define AT91C_BASE_DDR2CP1   (AT91_CAST(AT91PS_HDDRSDRC2) 	0xFFFFE400) // (DDR2CP1) Base Address
+#define AT91C_BASE_DDR2C     (AT91_CAST(AT91PS_HDDRSDRC2) 	0xFFFFE600) // (DDR2C) Base Address
+#define AT91C_BASE_SMC       (AT91_CAST(AT91PS_SMC) 	0xFFFFE800) // (SMC) Base Address
+#define AT91C_BASE_MATRIX    (AT91_CAST(AT91PS_MATRIX) 	0xFFFFEA00) // (MATRIX) Base Address
+#define AT91C_BASE_AIC       (AT91_CAST(AT91PS_AIC) 	0xFFFFF000) // (AIC) Base Address
+#define AT91C_BASE_PDC_DBGU  (AT91_CAST(AT91PS_PDC) 	0xFFFFEF00) // (PDC_DBGU) Base Address
+#define AT91C_BASE_DBGU      (AT91_CAST(AT91PS_DBGU) 	0xFFFFEE00) // (DBGU) Base Address
+#define AT91C_BASE_PIOA      (AT91_CAST(AT91PS_PIO) 	0xFFFFF200) // (PIOA) Base Address
+#define AT91C_BASE_PIOB      (AT91_CAST(AT91PS_PIO) 	0xFFFFF400) // (PIOB) Base Address
+#define AT91C_BASE_PIOC      (AT91_CAST(AT91PS_PIO) 	0xFFFFF600) // (PIOC) Base Address
+#define AT91C_BASE_PIOD      (AT91_CAST(AT91PS_PIO) 	0xFFFFF800) // (PIOD) Base Address
+#define AT91C_BASE_PIOE      (AT91_CAST(AT91PS_PIO) 	0xFFFFFA00) // (PIOE) Base Address
+#define AT91C_BASE_PMC       (AT91_CAST(AT91PS_PMC) 	0xFFFFFC00) // (PMC) Base Address
+#define AT91C_BASE_CKGR      (AT91_CAST(AT91PS_CKGR) 	0xFFFFFC1C) // (CKGR) Base Address
+#define AT91C_BASE_RSTC      (AT91_CAST(AT91PS_RSTC) 	0xFFFFFD00) // (RSTC) Base Address
+#define AT91C_BASE_SHDWC     (AT91_CAST(AT91PS_SHDWC) 	0xFFFFFD10) // (SHDWC) Base Address
+#define AT91C_BASE_RTTC      (AT91_CAST(AT91PS_RTTC) 	0xFFFFFD20) // (RTTC) Base Address
+#define AT91C_BASE_PITC      (AT91_CAST(AT91PS_PITC) 	0xFFFFFD30) // (PITC) Base Address
+#define AT91C_BASE_WDTC      (AT91_CAST(AT91PS_WDTC) 	0xFFFFFD40) // (WDTC) Base Address
+#define AT91C_BASE_RTC       (AT91_CAST(AT91PS_RTC) 	0xFFFFFDB0) // (RTC) Base Address
+#define AT91C_BASE_TC0       (AT91_CAST(AT91PS_TC) 	0xFFF7C000) // (TC0) Base Address
+#define AT91C_BASE_TC1       (AT91_CAST(AT91PS_TC) 	0xFFF7C040) // (TC1) Base Address
+#define AT91C_BASE_TC2       (AT91_CAST(AT91PS_TC) 	0xFFF7C080) // (TC2) Base Address
+#define AT91C_BASE_TC3       (AT91_CAST(AT91PS_TC) 	0xFFFD4000) // (TC3) Base Address
+#define AT91C_BASE_TC4       (AT91_CAST(AT91PS_TC) 	0xFFFD4040) // (TC4) Base Address
+#define AT91C_BASE_TC5       (AT91_CAST(AT91PS_TC) 	0xFFFD4080) // (TC5) Base Address
+#define AT91C_BASE_TCB0      (AT91_CAST(AT91PS_TCB) 	0xFFF7C000) // (TCB0) Base Address
+#define AT91C_BASE_TCB1      (AT91_CAST(AT91PS_TCB) 	0xFFFD4000) // (TCB1) Base Address
+#define AT91C_BASE_MCI0      (AT91_CAST(AT91PS_MCI) 	0xFFF80000) // (MCI0) Base Address
+#define AT91C_BASE_MCI1      (AT91_CAST(AT91PS_MCI) 	0xFFFD0000) // (MCI1) Base Address
+#define AT91C_BASE_TWI0      (AT91_CAST(AT91PS_TWI) 	0xFFF84000) // (TWI0) Base Address
+#define AT91C_BASE_TWI1      (AT91_CAST(AT91PS_TWI) 	0xFFF88000) // (TWI1) Base Address
+#define AT91C_BASE_PDC_US0   (AT91_CAST(AT91PS_PDC) 	0xFFF8C100) // (PDC_US0) Base Address
+#define AT91C_BASE_US0       (AT91_CAST(AT91PS_USART) 	0xFFF8C000) // (US0) Base Address
+#define AT91C_BASE_PDC_US1   (AT91_CAST(AT91PS_PDC) 	0xFFF90100) // (PDC_US1) Base Address
+#define AT91C_BASE_US1       (AT91_CAST(AT91PS_USART) 	0xFFF90000) // (US1) Base Address
+#define AT91C_BASE_PDC_US2   (AT91_CAST(AT91PS_PDC) 	0xFFF94100) // (PDC_US2) Base Address
+#define AT91C_BASE_US2       (AT91_CAST(AT91PS_USART) 	0xFFF94000) // (US2) Base Address
+#define AT91C_BASE_PDC_US3   (AT91_CAST(AT91PS_PDC) 	0xFFF98100) // (PDC_US3) Base Address
+#define AT91C_BASE_US3       (AT91_CAST(AT91PS_USART) 	0xFFF98000) // (US3) Base Address
+#define AT91C_BASE_PDC_SSC0  (AT91_CAST(AT91PS_PDC) 	0xFFF9C100) // (PDC_SSC0) Base Address
+#define AT91C_BASE_SSC0      (AT91_CAST(AT91PS_SSC) 	0xFFF9C000) // (SSC0) Base Address
+#define AT91C_BASE_PDC_SSC1  (AT91_CAST(AT91PS_PDC) 	0xFFFA0100) // (PDC_SSC1) Base Address
+#define AT91C_BASE_SSC1      (AT91_CAST(AT91PS_SSC) 	0xFFFA0000) // (SSC1) Base Address
+#define AT91C_BASE_PWMC_CH0  (AT91_CAST(AT91PS_PWMC_CH) 	0xFFFB8200) // (PWMC_CH0) Base Address
+#define AT91C_BASE_PWMC_CH1  (AT91_CAST(AT91PS_PWMC_CH) 	0xFFFB8220) // (PWMC_CH1) Base Address
+#define AT91C_BASE_PWMC_CH2  (AT91_CAST(AT91PS_PWMC_CH) 	0xFFFB8240) // (PWMC_CH2) Base Address
+#define AT91C_BASE_PWMC_CH3  (AT91_CAST(AT91PS_PWMC_CH) 	0xFFFB8260) // (PWMC_CH3) Base Address
+#define AT91C_BASE_PWMC      (AT91_CAST(AT91PS_PWMC) 	0xFFFB8000) // (PWMC) Base Address
+#define AT91C_BASE_PDC_SPI0  (AT91_CAST(AT91PS_PDC) 	0xFFFA4100) // (PDC_SPI0) Base Address
+#define AT91C_BASE_PDC_SPI1  (AT91_CAST(AT91PS_PDC) 	0xFFFA8100) // (PDC_SPI1) Base Address
+#define AT91C_BASE_SPI0      (AT91_CAST(AT91PS_SPI) 	0xFFFA4000) // (SPI0) Base Address
+#define AT91C_BASE_SPI1      (AT91_CAST(AT91PS_SPI) 	0xFFFA8000) // (SPI1) Base Address
+#define AT91C_BASE_PDC_TSADC (AT91_CAST(AT91PS_PDC) 	0xFFFB0100) // (PDC_TSADC) Base Address
+#define AT91C_BASE_TSADC     (AT91_CAST(AT91PS_TSADC) 	0xFFFB0000) // (TSADC) Base Address
+#define AT91C_BASE_UDPHS_EPTFIFO (AT91_CAST(AT91PS_UDPHS_EPTFIFO) 	0x00600000) // (UDPHS_EPTFIFO) Base Address
+#define AT91C_BASE_UDPHS_EPT_0 (AT91_CAST(AT91PS_UDPHS_EPT) 	0xFFF78100) // (UDPHS_EPT_0) Base Address
+#define AT91C_BASE_UDPHS_EPT_1 (AT91_CAST(AT91PS_UDPHS_EPT) 	0xFFF78120) // (UDPHS_EPT_1) Base Address
+#define AT91C_BASE_UDPHS_EPT_2 (AT91_CAST(AT91PS_UDPHS_EPT) 	0xFFF78140) // (UDPHS_EPT_2) Base Address
+#define AT91C_BASE_UDPHS_EPT_3 (AT91_CAST(AT91PS_UDPHS_EPT) 	0xFFF78160) // (UDPHS_EPT_3) Base Address
+#define AT91C_BASE_UDPHS_EPT_4 (AT91_CAST(AT91PS_UDPHS_EPT) 	0xFFF78180) // (UDPHS_EPT_4) Base Address
+#define AT91C_BASE_UDPHS_EPT_5 (AT91_CAST(AT91PS_UDPHS_EPT) 	0xFFF781A0) // (UDPHS_EPT_5) Base Address
+#define AT91C_BASE_UDPHS_EPT_6 (AT91_CAST(AT91PS_UDPHS_EPT) 	0xFFF781C0) // (UDPHS_EPT_6) Base Address
+#define AT91C_BASE_UDPHS_DMA_1 (AT91_CAST(AT91PS_UDPHS_DMA) 	0xFFF78310) // (UDPHS_DMA_1) Base Address
+#define AT91C_BASE_UDPHS_DMA_2 (AT91_CAST(AT91PS_UDPHS_DMA) 	0xFFF78320) // (UDPHS_DMA_2) Base Address
+#define AT91C_BASE_UDPHS_DMA_3 (AT91_CAST(AT91PS_UDPHS_DMA) 	0xFFF78330) // (UDPHS_DMA_3) Base Address
+#define AT91C_BASE_UDPHS_DMA_4 (AT91_CAST(AT91PS_UDPHS_DMA) 	0xFFF78340) // (UDPHS_DMA_4) Base Address
+#define AT91C_BASE_UDPHS_DMA_5 (AT91_CAST(AT91PS_UDPHS_DMA) 	0xFFF78350) // (UDPHS_DMA_5) Base Address
+#define AT91C_BASE_UDPHS_DMA_6 (AT91_CAST(AT91PS_UDPHS_DMA) 	0xFFF78360) // (UDPHS_DMA_6) Base Address
+#define AT91C_BASE_UDPHS     (AT91_CAST(AT91PS_UDPHS) 	0xFFF78000) // (UDPHS) Base Address
+#define AT91C_BASE_PDC_AC97C (AT91_CAST(AT91PS_PDC) 	0xFFFAC100) // (PDC_AC97C) Base Address
+#define AT91C_BASE_AC97C     (AT91_CAST(AT91PS_AC97C) 	0xFFFAC000) // (AC97C) Base Address
+#define AT91C_BASE_LCDC      (AT91_CAST(AT91PS_LCDC) 	0x00500000) // (LCDC) Base Address
+#define AT91C_BASE_LCDC_16B_TFT (AT91_CAST(AT91PS_LCDC) 	0x00500000) // (LCDC_16B_TFT) Base Address
+#define AT91C_BASE_HDMA_CH_0 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFEC3C) // (HDMA_CH_0) Base Address
+#define AT91C_BASE_HDMA_CH_1 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFEC64) // (HDMA_CH_1) Base Address
+#define AT91C_BASE_HDMA_CH_2 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFEC8C) // (HDMA_CH_2) Base Address
+#define AT91C_BASE_HDMA_CH_3 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFECB4) // (HDMA_CH_3) Base Address
+#define AT91C_BASE_HDMA_CH_4 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFECDC) // (HDMA_CH_4) Base Address
+#define AT91C_BASE_HDMA_CH_5 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFED04) // (HDMA_CH_5) Base Address
+#define AT91C_BASE_HDMA_CH_6 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFED2C) // (HDMA_CH_6) Base Address
+#define AT91C_BASE_HDMA_CH_7 (AT91_CAST(AT91PS_HDMA_CH) 	0xFFFFED54) // (HDMA_CH_7) Base Address
+#define AT91C_BASE_HDMA      (AT91_CAST(AT91PS_HDMA) 	0xFFFFEC00) // (HDMA) Base Address
+#define AT91C_BASE_HECC      (AT91_CAST(AT91PS_ECC) 	0xFFFFE200) // (HECC) Base Address
+#define AT91C_BASE_EMACB     (AT91_CAST(AT91PS_EMAC) 	0xFFFBC000) // (EMACB) Base Address
+#define AT91C_BASE_ISI       (AT91_CAST(AT91PS_ISI) 	0xFFFB4000) // (ISI) Base Address
+#define AT91C_BASE_UHPHS_OHCI (AT91_CAST(AT91PS_UHPHS_OHCI) 	0x00700000) // (UHPHS_OHCI) Base Address
+#define AT91C_BASE_UHPHS_EHCI (AT91_CAST(AT91PS_UHPHS_EHCI) 	0x00800000) // (UHPHS_EHCI) Base Address
+#define AT91C_BASE_TRNG      (AT91_CAST(AT91PS_TRNG) 	0xFFFCC000) // (TRNG) Base Address
+
+// *****************************************************************************
+//               MEMORY MAPPING DEFINITIONS FOR AT91SAM9G45
+// *****************************************************************************
+// ITCM
+#define AT91C_ITCM 	 (0x00100000) // Maximum ITCM Area base address
+// DTCM
+#define AT91C_DTCM 	 (0x00200000) // Maximum DTCM Area base address
+// IRAM
+#define AT91C_IRAM 	 (0x00300000) // Maximum Internal SRAM base address
+#define AT91C_IRAM_SIZE	 (0x00010000) // Maximum Internal SRAM size in byte (64 Kbytes)
+// IRAM_MIN
+#define AT91C_IRAM_MIN	 (0x00300000) // Minimum Internal RAM base address
+#define AT91C_IRAM_MIN_SIZE	 (0x00004000) // Minimum Internal RAM size in byte (16 Kbytes)
+// IROM
+#define AT91C_IROM 	 (0x00400000) // Internal ROM base address
+#define AT91C_IROM_SIZE	 (0x00010000) // Internal ROM size in byte (64 Kbytes)
+// EBI_CS0
+#define AT91C_EBI_CS0	 (0x10000000) // EBI Chip Select 0 base address
+#define AT91C_EBI_CS0_SIZE	 (0x10000000) // EBI Chip Select 0 size in byte (262144 Kbytes)
+// EBI_CS1
+#define AT91C_EBI_CS1	 (0x20000000) // EBI Chip Select 1 base address
+#define AT91C_EBI_CS1_SIZE	 (0x10000000) // EBI Chip Select 1 size in byte (262144 Kbytes)
+// EBI_SDRAM
+#define AT91C_EBI_SDRAM	 (0x20000000) // SDRAM on EBI Chip Select 1 base address
+#define AT91C_EBI_SDRAM_SIZE	 (0x10000000) // SDRAM on EBI Chip Select 1 size in byte (262144 Kbytes)
+// EBI_SDRAM_16BIT
+#define AT91C_EBI_SDRAM_16BIT	 (0x20000000) // SDRAM on EBI Chip Select 1 base address
+#define AT91C_EBI_SDRAM_16BIT_SIZE	 (0x02000000) // SDRAM on EBI Chip Select 1 size in byte (32768 Kbytes)
+// EBI_SDRAM_32BIT
+#define AT91C_EBI_SDRAM_32BIT	 (0x20000000) // SDRAM on EBI Chip Select 1 base address
+#define AT91C_EBI_SDRAM_32BIT_SIZE	 (0x04000000) // SDRAM on EBI Chip Select 1 size in byte (65536 Kbytes)
+// EBI_CS2
+#define AT91C_EBI_CS2	 (0x30000000) // EBI Chip Select 2 base address
+#define AT91C_EBI_CS2_SIZE	 (0x10000000) // EBI Chip Select 2 size in byte (262144 Kbytes)
+// EBI_CS3
+#define AT91C_EBI_CS3	 (0x40000000) // EBI Chip Select 3 base address
+#define AT91C_EBI_CS3_SIZE	 (0x10000000) // EBI Chip Select 3 size in byte (262144 Kbytes)
+// EBI_SM
+#define AT91C_EBI_SM	 (0x40000000) // NANDFLASH on EBI Chip Select 3 base address
+#define AT91C_EBI_SM_SIZE	 (0x10000000) // NANDFLASH on EBI Chip Select 3 size in byte (262144 Kbytes)
+// EBI_CS4
+#define AT91C_EBI_CS4	 (0x50000000) // EBI Chip Select 4 base address
+#define AT91C_EBI_CS4_SIZE	 (0x10000000) // EBI Chip Select 4 size in byte (262144 Kbytes)
+// EBI_CF0
+#define AT91C_EBI_CF0	 (0x50000000) // CompactFlash 0 on EBI Chip Select 4 base address
+#define AT91C_EBI_CF0_SIZE	 (0x10000000) // CompactFlash 0 on EBI Chip Select 4 size in byte (262144 Kbytes)
+// EBI_CS5
+#define AT91C_EBI_CS5	 (0x60000000) // EBI Chip Select 5 base address
+#define AT91C_EBI_CS5_SIZE	 (0x10000000) // EBI Chip Select 5 size in byte (262144 Kbytes)
+// EBI_CF1
+#define AT91C_EBI_CF1	 (0x60000000) // CompactFlash 1 on EBIChip Select 5 base address
+#define AT91C_EBI_CF1_SIZE	 (0x10000000) // CompactFlash 1 on EBIChip Select 5 size in byte (262144 Kbytes)
+// DDR2
+#define AT91C_DDR2 	 (0x70000000) // DDR2/LPDDR space base address
+#define AT91C_DDR2_SIZE	 (0x10000000) // DDR2/LPDDR space size in byte (262144 Kbytes)
+
+#endif
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/chip.h b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/chip.h
new file mode 100644
index 0000000000000000000000000000000000000000..609914caac591158a0bd52428a26e64b79b30217
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/chip.h
@@ -0,0 +1,132 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+ 
+//------------------------------------------------------------------------------
+/// \unit
+/// !Purpose
+///
+/// Definition of AT91SAM9G45 characteristics and features
+///
+/// !Usage
+/// -# For ARM core feature, see "AT91SAM9G45 - ARM core features".
+/// -# For IP features, see "AT91SAM9G45 - IP features".
+/// -# For misc, see "AT91SAM9G45 - Misc".
+//------------------------------------------------------------------------------
+ 
+#ifndef CHIP_H 
+#define CHIP_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "AT91SAM9G45 - ARM core features"
+/// This page lists several characteristics related to the ARM core
+///
+
+//ARM core features
+
+/// ARM core definition.
+#define arm926ej_s
+
+/// family definition.
+//#define at91sam9g45 (already defined)
+
+/// temporary define, to be removed
+#define CP15_PRESENT
+
+//------------------------------------------------------------------------------
+/// \page "AT91SAM9G45 - IP features"
+/// This page lists several characteristics related to the embedded IP
+///
+
+//IP FEATURES
+
+// DMA channels number
+#define CHIP_DMA_CHANNEL_NUM   8
+
+// Indicate chip's MCI interface. 
+#define MCI2_INTERFACE
+
+/// Indicates chip has an UDP High Speed. 
+#define CHIP_USB_UDPHS 
+
+/// Indicates chip has an Host High Speed. 
+#define CHIP_USB_UHP_OHCI 
+#define CHIP_USB_UHP_EHCI 
+
+/// Indicates chip has an internal pull-up. 
+#define CHIP_USB_PULLUP_INTERNAL 
+
+/// Number of USB endpoints 
+#define CHIP_USB_NUMENDPOINTS 7 
+
+/// Endpoints max paxcket size 
+#define CHIP_USB_ENDPOINTS_MAXPACKETSIZE(i) \
+   ((i == 0) ? 64 : \
+   ((i == 1) ? 1024 : \
+   ((i == 2) ? 1024 : \
+   ((i == 3) ? 1024 : \
+   ((i == 4) ? 1024 : \
+   ((i == 5) ? 1024 : \
+   ((i == 6) ? 1024 : 0 )))))))
+
+/// Endpoints Number of Bank 
+#define CHIP_USB_ENDPOINTS_BANKS(i) \
+   ((i == 0) ? 1 : \
+   ((i == 1) ? 2 : \
+   ((i == 2) ? 2 : \
+   ((i == 3) ? 3 : \
+   ((i == 4) ? 3 : \
+   ((i == 5) ? 3 : \
+   ((i == 6) ? 3 : 0 )))))))
+
+/// Endpoints max paxcket size 
+#define CHIP_USB_ENDPOINTS_DMA(i) \
+   ((i == 1) ? 1 : \
+   ((i == 2) ? 1 : \
+   ((i == 3) ? 1 : \
+   ((i == 4) ? 1 : \
+   ((i == 5) ? 1 : \
+   ((i == 6) ? 1 : 0 ))))))
+
+//------------------------------------------------------------------------------
+/// \page "AT91SAM9G45 - Misc "
+/// This page lists misc features
+///
+
+//Misc 
+
+#endif //#ifndef CHIP_H
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/chip.mak b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/chip.mak
new file mode 100644
index 0000000000000000000000000000000000000000..ce47fada5ca046713fc613c1106c32286bfd8c83
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/chip.mak
@@ -0,0 +1,34 @@
+# ----------------------------------------------------------------------------
+#         ATMEL Microcontroller Software Support 
+# ----------------------------------------------------------------------------
+# Copyright (c) 2008, Atmel Corporation
+#
+# All rights reserved.
+#
+# Redistribution and use in source and binary forms, with or without
+# modification, are permitted provided that the following conditions are met:
+#
+# - Redistributions of source code must retain the above copyright notice,
+# this list of conditions and the disclaimer below.
+#
+# Atmel's name may not be used to endorse or promote products derived from
+# this software without specific prior written permission.
+#
+# DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+# MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+# DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+# LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+# OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+# LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+# NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+# EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+# ----------------------------------------------------------------------------
+
+# Defines which are the specific available IP for the chip AT91SAM9G45
+CHIP_CORE    = arm926ej_s
+CHIP_IP_MCI  = MCI_DMA
+CHIP_IP_UDP  = USB_UDPHS
+CHIP_IP_UHP  = USB_EHCI
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.icf b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.icf
new file mode 100644
index 0000000000000000000000000000000000000000..960c46313b6b07b3cb16fa78aa33640099853518
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.icf
@@ -0,0 +1,46 @@
+/*###ICF### Section handled by ICF editor, don't touch! ****/
+/*-Editor annotation file-*/
+/* IcfEditorFile="$TOOLKIT_DIR$\config\ide\IcfEditor\a_v1_0.xml" */
+/*-Memory Regions-*/
+define symbol __ICFEDIT_region_DDRAM_start__ = 0x70000000;
+define symbol __ICFEDIT_region_DDRAM_end__   = 0x73FFFFFF;
+define symbol __ICFEDIT_region_RAM_start__   = 0x300000;
+define symbol __ICFEDIT_region_RAM_end__     = 0x30FFFF;
+/*-Sizes-*/
+define symbol __ICFEDIT_size_startup__  = 0x100;
+define symbol __ICFEDIT_size_vectors__  = 0x100;
+define symbol __ICFEDIT_size_cstack__   = 0x2000;
+define symbol __ICFEDIT_size_sysstack__ = 0x60;
+define symbol __ICFEDIT_size_irqstack__ = 0x60;
+define symbol __ICFEDIT_size_heap__     = 0x0;
+/*-Exports-*/
+export symbol __ICFEDIT_region_DDRAM_start__;
+export symbol __ICFEDIT_region_DDRAM_end__;
+export symbol __ICFEDIT_region_RAM_start__;
+export symbol __ICFEDIT_region_RAM_end__;
+export symbol __ICFEDIT_size_startup__;
+export symbol __ICFEDIT_size_vectors__;
+export symbol __ICFEDIT_size_cstack__;
+export symbol __ICFEDIT_size_sysstack__;
+export symbol __ICFEDIT_size_irqstack__;
+export symbol __ICFEDIT_size_heap__;
+/**** End of ICF editor section. ###ICF###*/
+
+define memory mem with size = 4G;
+define region STA_region =   mem:[from __ICFEDIT_region_DDRAM_start__ size __ICFEDIT_size_startup__];
+define region DDRAM_region = mem:[from __ICFEDIT_region_DDRAM_start__+__ICFEDIT_size_startup__ to __ICFEDIT_region_DDRAM_end__];
+define region VEC_region =   mem:[from __ICFEDIT_region_RAM_start__ size __ICFEDIT_size_vectors__];
+define region RAM_region =   mem:[from __ICFEDIT_region_RAM_start__+__ICFEDIT_size_vectors__ to __ICFEDIT_region_RAM_end__];
+
+define block CSTACK    with alignment = 8, size = __ICFEDIT_size_cstack__   { };
+define block SYS_STACK with alignment = 8, size = __ICFEDIT_size_sysstack__ { };
+define block IRQ_STACK with alignment = 8, size = __ICFEDIT_size_irqstack__ { };
+define block HEAP      with alignment = 8, size = __ICFEDIT_size_heap__     { };
+
+initialize by copy { section .vectors };
+do not initialize  { section .noinit };
+
+place in STA_region { section .cstartup };
+place in VEC_region { section .vectors };
+place in DDRAM_region { readonly, readwrite, block IRQ_STACK, block SYS_STACK, block CSTACK, block HEAP };
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.lds b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.lds
new file mode 100644
index 0000000000000000000000000000000000000000..3a784d7344855ff88cc7eba4aa79bd18b4d364ae
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.lds
@@ -0,0 +1,88 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+/*------------------------------------------------------------------------------
+ *      Linker script for running in external DDRAM on the AT91SAM9G45
+ *----------------------------------------------------------------------------*/
+
+OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
+OUTPUT_ARCH(arm)
+ENTRY(entry)
+
+MEMORY
+{
+    sram (W!RX) : ORIGIN = 0x300000, LENGTH = 64K
+    ddr_ebi0 (W!RX) : ORIGIN = 0x70000000, LENGTH = 64M
+}
+
+SECTIONS
+{  
+    .fixed :
+    {
+        . = ALIGN(4);
+        _sfixed = .;
+        *(.text*)
+        *(.rodata*)
+        *(.glue_7)
+        *(.glue_7t)
+        *(.data)
+        *(.CP15_*)
+        . = ALIGN(4);
+        _efixed = .;
+    } >ddr_ebi0
+
+    .prerelocate : AT (_efixed)
+    {
+        . = ALIGN(4);
+        _sprerelocate = .;
+        . = ALIGN(4);
+        _eprerelocate = .;
+    }
+
+    .postrelocate : AT (_efixed + SIZEOF(.prerelocate))
+    {
+        . = ALIGN(4);
+        _spostrelocate = .;
+        *(.vectors);
+        *(.ramfunc)
+        . = ALIGN(4);
+        _epostrelocate = .;
+    } >sram
+
+    .bss (NOLOAD) : {
+        _szero = .;
+        *(.bss)
+        . = ALIGN(4);
+        _ezero = .;
+    } >ddr_ebi0
+    
+    _sstack = 0x70000000 + 64 * 1024 * 1024;
+}
+end = .;
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.sct b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.sct
new file mode 100644
index 0000000000000000000000000000000000000000..bd2de765e45a481e0e4f3ea6da1b79cc57c54aa3
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram.sct
@@ -0,0 +1,49 @@
+; * ----------------------------------------------------------------------------
+; *         ATMEL Microcontroller Software Support 
+; * ----------------------------------------------------------------------------
+; * Copyright (c) 2008, Atmel Corporation
+; *
+; * All rights reserved.
+; *
+; * Redistribution and use in source and binary forms, with or without
+; * modification, are permitted provided that the following conditions are met:
+; *
+; * - Redistributions of source code must retain the above copyright notice,
+; * this list of conditions and the disclaimer below.
+; *
+; * Atmel's name may not be used to endorse or promote products derived from
+; * this software without specific prior written permission.
+; *
+; * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+; * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+; * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+; * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+; * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+; * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+; * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+; * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+; * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+; * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+; * ----------------------------------------------------------------------------
+
+; *------------------------------------------------------------------------------
+; *      Linker scatter for running in external DDRAM on the AT91SAM9G45
+; *----------------------------------------------------------------------------*/
+
+Load_region 0x70000000 0x4000000 {
+
+    Fixed_region 0x70000000 {
+        *(cstartup +First)
+       .ANY (+RO +RW +ZI)
+    }
+  
+    Relocate_region 0x300000 0x10000 {
+        *.o (VECTOR, +First)   
+    }
+  
+    ARM_LIB_HEAP 0x73FFE000 EMPTY 0x1000 {
+    }
+    
+    ARM_LIB_STACK 0x74000000 EMPTY -0x1000 {
+    }
+}
\ No newline at end of file
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram_flashloader.icf b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram_flashloader.icf
new file mode 100644
index 0000000000000000000000000000000000000000..d13e38469deb83da2cdd8a1d00fd96bdbbab7634
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram_flashloader.icf
@@ -0,0 +1,45 @@
+/*###ICF### Section handled by ICF editor, don't touch! ****/
+/*-Editor annotation file-*/
+/* IcfEditorFile="$TOOLKIT_DIR$\config\ide\IcfEditor\a_v1_0.xml" */
+/*-Specials-*/
+define symbol __ICFEDIT_intvec_start__ 		 = 0x00000000;
+/*-Memory Regions-*/
+define symbol __ICFEDIT_region_ROM_start__   = 0x0;
+define symbol __ICFEDIT_region_ROM_end__     = 0x0;
+define symbol __ICFEDIT_region_RAM_start__   = 0x70000000;
+define symbol __ICFEDIT_region_RAM_end__     = 0x73FFFFFF;
+
+/*-Sizes-*/
+define symbol __ICFEDIT_size_cstack__   = 0x200;
+define symbol __ICFEDIT_size_svcstack__ = 0x0;
+define symbol __ICFEDIT_size_irqstack__ = 0x0;
+define symbol __ICFEDIT_size_fiqstack__ = 0x0;
+define symbol __ICFEDIT_size_undstack__ = 0x0;
+define symbol __ICFEDIT_size_abtstack__ = 0x0;
+define symbol __ICFEDIT_size_heap__     = 0x0;
+/**** End of ICF editor section. ###ICF###*/
+
+
+define memory mem with size = 4G;
+define region RAM_region   = mem:[from __ICFEDIT_region_RAM_start__   to __ICFEDIT_region_RAM_end__];
+
+define block CSTACK    with alignment = 8, size = __ICFEDIT_size_cstack__   { };
+define block SVC_STACK with alignment = 8, size = __ICFEDIT_size_svcstack__ { };
+define block IRQ_STACK with alignment = 8, size = __ICFEDIT_size_irqstack__ { };
+define block FIQ_STACK with alignment = 8, size = __ICFEDIT_size_fiqstack__ { };
+define block UND_STACK with alignment = 8, size = __ICFEDIT_size_undstack__ { };
+define block ABT_STACK with alignment = 8, size = __ICFEDIT_size_abtstack__ { };
+define block HEAP      with alignment = 8, size = __ICFEDIT_size_heap__     { };
+
+//initialize by copy { readwrite };
+do not initialize  { section .noinit };
+
+place at address mem:__ICFEDIT_intvec_start__ {section .intvec };
+
+place at start of RAM_region { block RamTop with fixed order {readonly, section LOWEND}};
+place at end of RAM_region { block RamBottom with fixed order {section HIGHSTART, readwrite, section .noinit,
+                        block CSTACK, block SVC_STACK, block IRQ_STACK, block FIQ_STACK,
+                        block UND_STACK, block ABT_STACK, block HEAP}};
+
+
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram_samba.lds b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram_samba.lds
new file mode 100644
index 0000000000000000000000000000000000000000..a31265009b54622d8993e534f86c6385e45646c6
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/ddram_samba.lds
@@ -0,0 +1,89 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+/*------------------------------------------------------------------------------
+ *      Linker script for running in external DDRAM on the AT91SAM9G45
+ *----------------------------------------------------------------------------*/
+
+OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
+OUTPUT_ARCH(arm)
+ENTRY(entry)
+
+MEMORY
+{
+    sram (W!RX) : ORIGIN = 0x300000, LENGTH = 64K
+    ddr_ebi0 (W!RX) : ORIGIN = 0x70000000, LENGTH = 64M
+    ddr_ebi1 (W!RX) : ORIGIN = 0x20000000, LENGTH = 64M
+}
+
+SECTIONS
+{  
+    .fixed :
+    {
+        . = ALIGN(4);
+        _sfixed = .;
+        *(.text*)
+        *(.rodata*)
+        *(.glue_7)
+        *(.glue_7t)
+        *(.data)
+        *(.CP15_*)
+        . = ALIGN(4);
+        _efixed = .;
+    } >ddr_ebi0
+
+    .prerelocate : AT (_efixed)
+    {
+        . = ALIGN(4);
+        _sprerelocate = .;
+        . = ALIGN(4);
+        _eprerelocate = .;
+    }
+
+    .postrelocate : AT (_efixed + SIZEOF(.prerelocate))
+    {
+        . = ALIGN(4);
+        _spostrelocate = .;
+        *(.vectors);
+        *(.ramfunc)
+        . = ALIGN(4);
+        _epostrelocate = .;
+    } >sram
+
+    .bss (NOLOAD) : {
+        _szero = .;
+        *(.bss)
+        . = ALIGN(4);
+        _ezero = .;
+    } >ddr_ebi0
+    
+    _sstack = 0x70000000 + 64 * 1024 * 1024;
+}
+end = .;
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.icf b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.icf
new file mode 100644
index 0000000000000000000000000000000000000000..ecb72f65be21c73f3373495554138afd4dc73d92
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.icf
@@ -0,0 +1,36 @@
+/*###ICF### Section handled by ICF editor, don't touch! ****/
+/*-Editor annotation file-*/
+/* IcfEditorFile="$TOOLKIT_DIR$\config\ide\IcfEditor\a_v1_0.xml" */
+/*-Memory Regions-*/
+define symbol __ICFEDIT_region_RAM_start__ = 0x300000;
+define symbol __ICFEDIT_region_RAM_end__   = 0x30FFFF;
+/*-Sizes-*/
+define symbol __ICFEDIT_size_vectors__  = 0x100;
+define symbol __ICFEDIT_size_cstack__   = 0x2000; /* For nandflash */
+define symbol __ICFEDIT_size_sysstack__ = 0x60;
+define symbol __ICFEDIT_size_irqstack__ = 0x60;
+define symbol __ICFEDIT_size_heap__     = 0x0;
+/*-Exports-*/
+export symbol __ICFEDIT_region_RAM_start__;
+export symbol __ICFEDIT_region_RAM_end__;
+export symbol __ICFEDIT_size_vectors__;
+export symbol __ICFEDIT_size_cstack__;
+export symbol __ICFEDIT_size_sysstack__;
+export symbol __ICFEDIT_size_irqstack__;
+export symbol __ICFEDIT_size_heap__;
+/**** End of ICF editor section. ###ICF###*/
+
+define memory mem with size = 4G;
+define region VEC_region = mem:[from __ICFEDIT_region_RAM_start__ size __ICFEDIT_size_vectors__];
+define region RAM_region = mem:[from __ICFEDIT_region_RAM_start__+__ICFEDIT_size_vectors__ to __ICFEDIT_region_RAM_end__];
+
+define block CSTACK    with alignment = 8, size = __ICFEDIT_size_cstack__   { };
+define block SYS_STACK with alignment = 8, size = __ICFEDIT_size_sysstack__ { };
+define block IRQ_STACK with alignment = 8, size = __ICFEDIT_size_irqstack__ { };
+define block HEAP      with alignment = 8, size = __ICFEDIT_size_heap__     { };
+
+do not initialize  { section .noinit };
+
+place in VEC_region { section .vectors };
+place in RAM_region { section .cstartup, readonly, readwrite, block IRQ_STACK, block SYS_STACK, block CSTACK, block HEAP };
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.lds b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.lds
new file mode 100644
index 0000000000000000000000000000000000000000..b8c4697789cced74dd1f2a81d552c384ca4f7c26
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.lds
@@ -0,0 +1,97 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+/*------------------------------------------------------------------------------
+ *      Linker script for running in internal SRAM on the AT91SAM9G45
+ *----------------------------------------------------------------------------*/
+
+OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
+OUTPUT_ARCH(arm)
+ENTRY(entry)
+
+MEMORY
+{
+    sram (W!RX) : ORIGIN = 0x300000, LENGTH = 64K
+    ddr_ebi0 (W!RX) : ORIGIN = 0x70000000, LENGTH = 128M
+}
+
+SECTIONS
+{  
+    .fixed0 :
+    {
+        . = ALIGN(4);
+        _sfixed0 = .;
+        *(.vectors)
+        *(.ramfunc)
+        *(.text*)
+        *(.rodata*)
+        *(.data)
+        *(.glue_7)
+        *(.glue_7t)
+        *(.CP15_*)
+        . = ALIGN(4);
+        _efixed0 = .;
+        _efixed = .;
+    } >sram
+
+    .fixed1 :
+    {
+        . = ALIGN(4);
+        _sfixed1 = .;
+        . = ALIGN(4);
+        _efixed1 = .;
+    } >sram
+
+    .prerelocate : AT (_efixed)
+    {
+        . = ALIGN(4);
+        _sprerelocate = .;
+        . = ALIGN(4);
+        _eprerelocate = .;
+    }
+
+    .postrelocate : AT (_efixed + SIZEOF(.prerelocate))
+    {
+        . = ALIGN(4);
+        _spostrelocate = .;
+        . = ALIGN(4);
+        _epostrelocate = .;
+    }
+
+    .bss (NOLOAD) : {
+        _szero = .;
+        *(.bss)
+        . = ALIGN(4);
+        _ezero = .;
+    } >sram
+    
+    _sstack = 0x300000 + 64 * 1024;
+}
+end = .;
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.sct b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.sct
new file mode 100644
index 0000000000000000000000000000000000000000..b6802ec09acdd3beae48cbe2b2d6fee15adbec01
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram.sct
@@ -0,0 +1,53 @@
+; * ----------------------------------------------------------------------------
+; *         ATMEL Microcontroller Software Support 
+; * ----------------------------------------------------------------------------
+; * Copyright (c) 2008, Atmel Corporation
+; *
+; * All rights reserved.
+; *
+; * Redistribution and use in source and binary forms, with or without
+; * modification, are permitted provided that the following conditions are met:
+; *
+; * - Redistributions of source code must retain the above copyright notice,
+; * this list of conditions and the disclaimer below.
+; *
+; * Atmel's name may not be used to endorse or promote products derived from
+; * this software without specific prior written permission.
+; *
+; * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+; * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+; * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+; * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+; * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+; * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+; * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+; * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+; * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+; * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+; * ----------------------------------------------------------------------------
+
+; *------------------------------------------------------------------------------
+; *      Linker scatter for running in internal SRAM on the AT91SAM9g45
+; *----------------------------------------------------------------------------*/
+
+Load_region 0x300000 0x10000 {    
+
+    Fixed_region 0x300000 {
+        *.o (VECTOR, +First)
+        .ANY (+RO)
+    }
+    
+    Relocate_region +0  {
+        *(cstartup +First)
+        .ANY (+RW +ZI)
+    }
+    
+    ScatterAssert((ImageLength(Fixed_region) + ImageLength(Relocate_region)) <  0xF000)
+     
+    ARM_LIB_HEAP 0x30E000 EMPTY 0x1000 {
+    }
+    
+    ARM_LIB_STACK 0x310000 EMPTY -0x1000 {
+    }
+}
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram_samba.lds b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram_samba.lds
new file mode 100644
index 0000000000000000000000000000000000000000..245bfdc4956123e841ab3e4c95642f0b435a8019
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/at91sam9g45/sram_samba.lds
@@ -0,0 +1,99 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+/*------------------------------------------------------------------------------
+ *      Linker script for running in internal SRAM on the AT91SAM9G45
+ *----------------------------------------------------------------------------*/
+
+OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
+OUTPUT_ARCH(arm)
+ENTRY(entry)
+
+MEMORY
+{
+    romcodesram (W!RX) : ORIGIN = 0x30F000, LENGTH = 0x1000    
+    sram (W!RX) : ORIGIN = 0x300000, LENGTH = 0xF000
+    ddr_ebi0 (W!RX) : ORIGIN = 0x70000000, LENGTH = 128M
+    ddr_ebi1 (W!RX) : ORIGIN = 0x20000000, LENGTH = 128M
+}
+
+SECTIONS
+{  
+    .fixed0 :
+    {
+        . = ALIGN(4);
+        _sfixed0 = .;
+        *(.vectors)
+        *(.ramfunc)
+        *(.text*)
+        *(.rodata*)
+        *(.data)
+        *(.glue_7)
+        *(.glue_7t)
+        *(.CP15_*)
+        . = ALIGN(4);
+        _efixed0 = .;
+        _efixed = .;
+    } >sram
+
+    .fixed1 :
+    {
+        . = ALIGN(4);
+        _sfixed1 = .;
+        . = ALIGN(4);
+        _efixed1 = .;
+    } >sram
+
+    .prerelocate : AT (_efixed)
+    {
+        . = ALIGN(4);
+        _sprerelocate = .;
+        . = ALIGN(4);
+        _eprerelocate = .;
+    }
+
+    .postrelocate : AT (_efixed + SIZEOF(.prerelocate))
+    {
+        . = ALIGN(4);
+        _spostrelocate = .;
+        . = ALIGN(4);
+        _epostrelocate = .;
+    }
+
+    .bss (NOLOAD) : {
+        _szero = .;
+        *(.bss)
+        . = ALIGN(4);
+        _ezero = .;
+    } >sram
+    
+    _sstack = 0x30F000;
+}
+end = .;
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board.h b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board.h
new file mode 100644
index 0000000000000000000000000000000000000000..3c82f74cf9c0ee36c7b363ae4d1e7f5f5d9236b5
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board.h
@@ -0,0 +1,723 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+/// !Purpose
+///
+/// Definition and functions for using AT91SAM9G45-related features, such
+/// has PIO pins, memories, etc.
+///
+/// !Usage
+/// -# The code for booting the board is provided by board_cstartup.S and
+///    board_lowlevel.c.
+/// -# For using board PIOs, board characteristics (clock, etc.) and external
+///    components, see board.h.
+/// -# For manipulating memories (remapping, SDRAM, etc.), see board_memories.h.
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \unit
+/// !Purpose
+///
+/// Definition of AT91SAM9G45-EK characteristics, AT91SAM9G45-dependant PIOs and
+/// external components interfacing.
+///
+/// !Usage
+/// -# For operating frequency information, see "SAM9G45-EK - Operating frequencies".
+/// -# For using portable PIO definitions, see "SAM9G45-EK - PIO definitions".
+/// -# Several USB definitions are included here (see "SAM9G45-EK - USB device").
+/// -# For external components definitions, see "SAM9G45-EK - External components".
+/// -# For memory-related definitions, see "SAM79260-EK - Memories".
+//------------------------------------------------------------------------------
+
+#ifndef BOARD_H
+#define BOARD_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#if defined(at91sam9g45)
+    #include "at91sam9g45/chip.h"
+    #include "at91sam9g45/AT91SAM9G45.h"
+#else
+    #error Board does not support the specified chip.
+#endif
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SAM9G45-EK - Board Description"
+/// This page lists several definition related to the board description.
+///
+/// !Definitions
+/// - BOARD_NAME
+
+/// Name of the board.
+#define BOARD_NAME              "AT91SAM9G45-EK"
+/// Board definition.
+#define at91sam9g45ek
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SAM9G45-EK - Operating frequencies"
+/// This page lists several definition related to the board operating frequency
+/// (when using the initialization done by board_lowlevel.c).
+///
+/// !Definitions
+/// - BOARD_MAINOSC
+/// - BOARD_MCK
+
+/// Frequency of the board main oscillator.
+#define BOARD_MAINOSC           12000000
+
+/// Master clock frequency (when using board_lowlevel.c).
+// ((12MHz / DIVA / PLLADIV2 / MDIV) * (MULA+1)
+//#define BOARD_MCK               ((unsigned long)((BOARD_MAINOSC / 3 / 2 / 3) * 200 )) // 133MHz
+#define BOARD_MCK               ((unsigned long)((BOARD_MAINOSC / 3 / 2 / 4) * 200 )) // 100MHz
+
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SAM9G45-EK - USB device"
+///
+/// !Constants
+/// - BOARD_USB_BMATTRIBUTES
+
+/// USB attributes configuration descriptor (bus or self powered, remote wakeup)
+//#define BOARD_USB_BMATTRIBUTES USBConfigurationDescriptor_SELFPOWERED_RWAKEUP
+#define BOARD_USB_BMATTRIBUTES   USBConfigurationDescriptor_SELFPOWERED_NORWAKEUP
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SAM9G45-EK - PIO definitions"
+/// This pages lists all the pio definitions contained in board.h. The constants
+/// are named using the following convention: PIN_* for a constant which defines
+/// a single Pin instance (but may include several PIOs sharing the same
+/// controller), and PINS_* for a list of Pin instances.
+///
+/// !DBGU
+/// - PINS_DBGU
+///
+/// !LEDs
+/// - PIN_LED_0
+/// - PIN_LED_1
+/// - PINS_LEDS
+/// - LED_POWER
+/// - LED_DS1
+///
+/// !Push buttons
+/// - PIN_PUSHBUTTON_1
+/// - PIN_PUSHBUTTON_2
+/// - PINS_PUSHBUTTONS
+/// - PUSHBUTTON_BP1
+/// - PUSHBUTTON_BP2
+/// - JOYSTICK_LEFT
+/// - JOYSTICK_RIGHT
+///
+/// !Joystick buttons
+/// - PIN_JOYSTICK_UP
+/// - PIN_JOYSTICK_DOWN
+/// - PIN_JOYSTICK_LEFT
+/// - PIN_JOYSTICK_RIGHT
+/// - PIN_JOYSTICK_LCLIC, PIN_JOYSTICK_PUSH
+/// - PINS_JOYSTICK_MOVE, PINS_JOYSTICK_CLIC, PINS_JOYSTICK
+/// - JOYSTICK_UP
+/// - JOYSTICK_DOWN
+/// - JOYSTICK_LEFT
+/// - JOYSTICK_RIGHT
+/// - JOYSTICK_LCLIC, JOYSTICK_PUSH
+///
+/// !USART0
+/// - PIN_USART0_RXD
+/// - PIN_USART0_TXD
+///
+/// !SPI0
+/// - PIN_SPI0_MISO
+/// - PIN_SPI0_MOSI
+/// - PIN_SPI0_SPCK
+/// - PINS_SPI0
+/// - PIN_SPI0_NPCS0
+/// - PIN_SPI0_NPCS1
+///
+/// !SSC
+/// - PINS_SSC_TX
+///
+/// !USB
+/// - PIN_USB_VBUS
+///
+/// !MCI
+/// - PINS_MCI
+///
+/// !PWM
+/// - PIN_PWMC_PWM1
+/// - PIN_PWMC_PWM3
+/// - PIN_PWM_LED0
+/// - PIN_PWM_LED1
+/// - CHANNEL_PWM_LED0
+/// - CHANNEL_PWM_LED1
+///
+/// !TWI
+/// - PINS_TWI0
+///
+/// !TSADC
+/// - PINS_TSADCC
+
+/// List of all DBGU pin definitions.
+#define PINS_DBGU  {(1<<12) | (1<<13), AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+
+/// LED #0 pin definition.
+#define PIN_LED_0   {1 << 0, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_OUTPUT_1, PIO_DEFAULT}
+/// LED #1 pin definition.
+#define PIN_LED_1   {1 << 31, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_OUTPUT_1, PIO_DEFAULT}
+/// List of all LED definitions.
+#define PINS_LEDS   PIN_LED_0, PIN_LED_1
+/// Power LED index.
+#define LED_POWER       0
+/// DS1 LED index.
+#define LED_DS1         1
+
+/// Push button #1 pin definition.
+#define PIN_PUSHBUTTON_1  {1 << 6, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_PULLUP}
+/// Pusb button #2 pin definition.
+#define PIN_PUSHBUTTON_2  {1 << 7, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_PULLUP}
+/// List of all pushbutton pin definitions.
+#define PINS_PUSHBUTTONS  PIN_PUSHBUTTON_1, PIN_PUSHBUTTON_2
+/// Push button #1 index.
+#define PUSHBUTTON_BP1   0
+/// Push button #2 index.
+#define PUSHBUTTON_BP2   1
+
+// Joystick definition.
+/// Joystick UP.
+#define PIN_JOYSTICK_UP    {1 << 16, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_PULLUP}
+/// Joystick DOWN.
+#define PIN_JOYSTICK_DOWN  {1 << 17, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_PULLUP}
+/// Joystick LEFT.
+#define PIN_JOYSTICK_LEFT  {1 << 14, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_PULLUP}
+/// Joystick RIGHT.
+#define PIN_JOYSTICK_RIGHT {1 << 15, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_PULLUP}
+/// Joystick LEFT clic.
+#define PIN_JOYSTICK_LCLIC {1 << 18, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_PULLUP}
+/// Joystick PUSH button.
+#define PIN_JOYSTICK_PUSH  PIN_JOYSTICK_LCLIC
+/// List of all Joystick click definitions
+#define PINS_JOYSTICK_CLIC   PIN_JOYSTICK_LCLIC
+/// List of all Joystick movement direction definitions
+#define PINS_JOYSTICK_MOVE  PIN_JOYSTICK_UP, PIN_JOYSTICK_DOWN, \
+                            PIN_JOYSTICK_LEFT, PIN_JOYSTICK_RIGHT
+/// List of all Joystick definitions
+#define PINS_JOYSTICK  PINS_JOYSTICK_MOVE, \
+                       PINS_JOYSTICK_CLIC
+/// Joystick UP index.
+#define JOYSTICK_UP         0
+/// Joystick DOWN index.
+#define JOYSTICK_DOWN       1
+/// Joystick LEFT index.
+#define JOYSTICK_LEFT       2
+/// Joystick RIGHT index.
+#define JOYSTICK_RIGHT      3
+/// Joystick LEFT CLICK index.
+#define JOYSTICK_LCLIC      4
+/// Joystick PUSH button index.
+#define JOYSTICK_PUSH       4
+
+/// USART0 TXD pin definition.
+#define PIN_USART0_TXD  {1 << 19, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+/// USART0 RXD pin definition.
+#define PIN_USART0_RXD  {1 << 18, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+/// USART0 RTS pin definition.
+#define PIN_USART0_RTS  {1 << 17, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_B, PIO_DEFAULT}
+/// USART0 CTS pin definition.
+#define PIN_USART0_CTS  {1 << 15, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_B, PIO_DEFAULT}
+/// USART0 SCK pin definition.
+#define PIN_USART0_SCK  {1 << 16, AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
+/// USART1 TXD pin definition.
+#define PIN_USART1_TXD  {1 <<  4, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+/// USART1 RXD pin definition.
+#define PIN_USART1_RXD  {1 <<  5, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+/// USART1 RTS pin definition.
+#define PIN_USART1_RTS  {1 << 16, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_B, PIO_DEFAULT}
+/// USART1 CTS pin definition.
+#define PIN_USART1_CTS  {1 << 17, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_B, PIO_DEFAULT}
+/// USART1 SCK pin definition.
+#define PIN_USART1_SCK  {1 << 29, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_B, PIO_DEFAULT}
+
+
+/// SPI0 MISO pin definition.
+#define PIN_SPI0_MISO  {1 << 0, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_PULLUP}
+/// SPI0 MOSI pin definition.
+#define PIN_SPI0_MOSI  {1 << 1, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+/// SPI0 SPCK pin definition.
+#define PIN_SPI0_SPCK  {1 << 2, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+/// List of SPI0 pin definitions (MISO, MOSI & SPCK).
+#define PINS_SPI0      PIN_SPI0_MISO, PIN_SPI0_MOSI, PIN_SPI0_SPCK
+/// SPI0 chip select 0 pin definition.
+#define PIN_SPI0_NPCS0 {1 << 3, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+
+/// SSC transmitter pins definition.
+#define PINS_SSC_TX { (1 << 0) | (1 << 1) | (1 << 2), \
+                      AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_A, PIO_DEFAULT}
+
+/// USB VBus monitoring pin definition.
+#define PIN_USB_VBUS    {1 << 19, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_INPUT, PIO_DEFAULT}
+
+/// USB VBus supply pin definition (SP2526A-2, active LOW, default to OFF).
+#define PIN_USB_POWER_ENA {1 << 1, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_OUTPUT_1, PIO_DEFAULT}
+#define PIN_USB_POWER_ENB {1 << 3, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_OUTPUT_1, PIO_DEFAULT}
+
+/// List of MCI pins definitions.
+#define PINS_MCI0 \
+    {(0x3E <<  0), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_PULLUP}, \
+    {(0x1 <<  0), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
+#define PINS_MCI1 \
+    {(0x1F << 22), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_PULLUP}, \
+    {(0x1 <<  31), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
+#define PIN_MCI0_DAT0 \
+    {AT91C_PIO_PA2, AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_PULLUP}
+#define PIN_MCI1_DAT1 \
+    {AT91C_PIO_PA23, AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_PULLUP}
+#define PINS_MCI0_CD \
+    {AT91C_PIO_PD10, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_INPUT, PIO_PULLUP}
+#define PINS_MCI1_CD \
+    {AT91C_PIO_PD11, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_INPUT, PIO_PULLUP}
+#define PINS_MCI1_WP \
+    {AT91C_PIO_PD29, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_INPUT, PIO_PULLUP}
+
+/*
+#define PINS_MCI  \
+    {0x0000003B, AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_B, PIO_PULLUP}, \
+    {1 << 8, AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
+*/
+
+/// PWMC PWM0 pin definition.
+#define PIN_PWMC_PWM0  {1 << 24, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_B, PIO_DEFAULT}
+/// PWMC PWM1 pin definition.
+#define PIN_PWMC_PWM1  {1 << 31, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_B, PIO_DEFAULT}
+/// PWMC PWM2 pin definition.
+#define PIN_PWMC_PWM2  {1 << 26, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_B, PIO_DEFAULT}
+/// PWMC PWM2 pin definition.
+#define PIN_PWMC_PWM3  {1 <<  0, AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_B, PIO_DEFAULT}
+
+/// PWM pin definition for LED0
+#define PIN_PWM_LED0 PIN_PWMC_PWM3
+/// PWM pin definition for LED1
+#define PIN_PWM_LED1 PIN_PWMC_PWM1
+/// PWM channel for LED0
+#define CHANNEL_PWM_LED0 3
+/// PWM channel for LED1
+#define CHANNEL_PWM_LED1 1
+
+/// TWI  version 3xx
+#define TWI_V3XX
+/// TWI pins definition.
+#define PINS_TWI0  {(1<<20) | (1<<21), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
+
+/// TSADCC pins definition.
+#define PINS_TSADCC {(1 << 20)|(1 << 21)|(1 << 22)|(1 << 23),\
+                     AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_A, PIO_DEFAULT}
+
+/// PCK0: PA31.B, PD12.B, PE0.B
+//#define PIN_PCK0    {1 << 12, AT91C_BASE_PIOA, AT91C_ID_PIOABCD, PIO_PERIPH_B, PIO_DEFAULT}
+/// PCK1: PB31.B, PE31.B, 
+#define PIN_PCK1    {1 << 31, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_B, PIO_DEFAULT}
+
+/// PIN used for reset the smartcard
+#define PIN_ISO7816_RSTMC       {1 << 7, AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}
+
+/// Pins used for connect the smartcard
+#define PINS_ISO7816            PIN_USART0_TXD, PIN_USART0_SCK, PIN_ISO7816_RSTMC
+
+/// IRDA SD pin
+#define PIN_IRDA_SD {0x1 << 8, AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_OUTPUT_1, PIO_DEFAULT}
+
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SAM9G45-EK - External components"
+/// This page lists the definitions related to external on-board components
+/// located in the board.h file for the AT91SAM9G45-EK.
+///
+/// !AT45 Dataflash Card (A)
+/// - BOARD_AT45_A_SPI_BASE
+/// - BOARD_AT45_A_SPI_ID
+/// - BOARD_AT45_A_SPI_PINS
+/// - BOARD_AT45_A_SPI
+/// - BOARD_AT45_A_NPCS
+/// - BOARD_AT45_A_NPCS_PIN
+///
+/// !AT45 Dataflash (B)
+/// - BOARD_AT45_B_SPI_BASE
+/// - BOARD_AT45_B_SPI_ID
+/// - BOARD_AT45_B_SPI_PINS
+/// - BOARD_AT45_B_SPI
+/// - BOARD_AT45_B_NPCS
+/// - BOARD_AT45_B_NPCS_PIN
+///
+/// !LCD
+/// - PINS_LCD
+/// - BOARD_LCD_WIDTH
+/// - BOARD_LCD_HEIGHT
+/// - BOARD_LCD_BPP
+/// - BOARD_LCD_IFWIDTH
+/// - BOARD_LCD_FRAMESIZE_PIXELS
+/// - BOARD_LCD_FRAMESIZE
+/// - BOARD_LCD_FRAMERATE
+/// - BOARD_LCD_PIXELCLOCK
+/// - BOARD_LCD_DISPLAYTYPE
+/// - BOARD_LCD_POLARITY_INVVD
+/// - BOARD_LCD_POLARITY_INVFRAME
+/// - BOARD_LCD_POLARITY_INVLINE
+/// - BOARD_LCD_POLARITY_INVCLK
+/// - BOARD_LCD_POLARITY_INVDVAL
+/// - BOARD_LCD_CLOCKMODE
+/// - BOARD_LCD_TIMING_VFP
+/// - BOARD_LCD_TIMING_VBP
+/// - BOARD_LCD_TIMING_VPW
+/// - BOARD_LCD_TIMING_VHDLY
+/// - BOARD_LCD_TIMING_HFP
+/// - BOARD_LCD_TIMING_HBP
+/// - BOARD_LCD_TIMING_HPW
+/// 
+/// !Touchscreen
+/// - BOARD_TOUCHSCREEN_ADCCLK
+/// - BOARD_TOUCHSCREEN_STARTUP
+/// - BOARD_TOUCHSCREEN_SHTIM
+/// - BOARD_TOUCHSCREEN_DEBOUNCE
+/// 
+/// !SD Card
+/// - BOARD_SD_MCI_BASE
+/// - BOARD_SD_MCI_ID
+/// - BOARD_SD_PINS
+/// - BOARD_SD_SLOT
+/// - BOARD_SD_BOOT_MCISLOT
+///
+/// !AC97
+/// - PINS_AC97
+///
+/// !ISI
+/// - BOARD_ISI_PIO_CNTRL1
+/// - BOARD_ISI_PIO_CNTRL2
+/// - BOARD_ISI_TWCK
+/// - BOARD_ISI_TWD
+/// - BOARD_ISI_MCK
+/// - BOARD_ISI_VSYNC
+/// - BOARD_ISI_HSYNC
+/// - BOARD_ISI_PCK
+/// - BOARD_ISI_PINS_DATA
+
+
+
+/// Base address of SPI peripheral connected to the dataflash.
+#define BOARD_AT45_A_SPI_BASE         AT91C_BASE_SPI0
+/// Identifier of SPI peripheral connected to the dataflash.
+#define BOARD_AT45_A_SPI_ID           AT91C_ID_SPI0
+/// Pins of the SPI peripheral connected to the dataflash.
+#define BOARD_AT45_A_SPI_PINS         PINS_SPI0
+/// Dataflash SPI number.
+#define BOARD_AT45_A_SPI              0
+/// Chip select connected to the dataflash.
+#define BOARD_AT45_A_NPCS             0
+/// Chip select pin connected to the dataflash.
+#define BOARD_AT45_A_NPCS_PIN         PIN_SPI0_NPCS0
+
+
+/// Base address of SPI peripheral connected to the serialflash.
+#define BOARD_AT26_A_SPI_BASE         AT91C_BASE_SPI0
+/// Identifier of SPI peripheral connected to the dataflash.
+#define BOARD_AT26_A_SPI_ID           AT91C_ID_SPI0
+/// Pins of the SPI peripheral connected to the dataflash.
+#define BOARD_AT26_A_SPI_PINS         PINS_SPI0
+/// Dataflahs SPI number.
+#define BOARD_AT26_A_SPI              0
+/// Chip select connected to the dataflash.
+#define BOARD_AT26_A_NPCS             0
+/// Chip select pin connected to the dataflash.
+#define BOARD_AT26_A_NPCS_PIN         PIN_SPI0_NPCS0
+
+/// LCD pin list.
+#define PINS_LCD    \
+    {0x7FFFFFFD, AT91C_BASE_PIOE, AT91C_ID_PIOD_E, PIO_PERIPH_A, PIO_DEFAULT}
+
+/// LCD enable & disable pin list
+#define BOARD_LCD_ENABLE     {0x05, AT91C_BASE_PIOE, AT91C_ID_PIOD_E, PIO_OUTPUT_1, PIO_DEFAULT},\
+                             {0x40, AT91C_BASE_PIOE, AT91C_ID_PIOD_E, PIO_PERIPH_A, PIO_DEFAULT}
+#define BOARD_LCD_DISABLE    {0x45, AT91C_BASE_PIOE, AT91C_ID_PIOD_E, PIO_OUTPUT_0, PIO_DEFAULT}
+
+/// TV enable & disable pin list
+#define BOARD_TV_ENABLE      {0x40, AT91C_BASE_PIOE, AT91C_ID_PIOD_E, PIO_PERIPH_A, PIO_DEFAULT}
+#define BOARD_TV_DISABLE     {0x40, AT91C_BASE_PIOE, AT91C_ID_PIOD_E, PIO_OUTPUT_0, PIO_DEFAULT}
+
+/// Board is wired in BGR 565.
+#define BOARD_LCD_BGR565
+/// LCD pixel clock is not divide by two
+//#define LCDC_PIXELCLOCK_DOUBLE
+/// Display width in pixels.
+#define BOARD_LCD_WIDTH             480
+/// Display height in pixels.
+#define BOARD_LCD_HEIGHT            272
+/// Display resolution in bits per pixel (bpp).
+#define BOARD_LCD_BPP               AT91C_LCDC_PIXELSIZE_TWENTYFOURBITSPERPIXEL
+/// Display interface width in bits.
+#define BOARD_LCD_IFWIDTH           24
+/// Frame size in pixels (height * width * bpp).
+#define BOARD_LCD_FRAMESIZE_PIXELS  (BOARD_LCD_WIDTH * BOARD_LCD_HEIGHT * 24)
+/// Frame size in words (height * width * bpp / 32)
+#define BOARD_LCD_FRAMESIZE         (BOARD_LCD_FRAMESIZE_PIXELS / 32)
+/// Frame rate in Hz.
+#define BOARD_LCD_FRAMERATE         60
+/// Pixel clock rate in Hz (frameSize * frameRate / interfaceWidth).
+#define BOARD_LCD_PIXELCLOCK        (BOARD_LCD_FRAMESIZE_PIXELS * BOARD_LCD_FRAMERATE / BOARD_LCD_IFWIDTH)
+/// LCD display type.
+#define BOARD_LCD_DISPLAYTYPE       AT91C_LCDC_DISTYPE_TFT
+/// LCDC polarity.
+#define BOARD_LCD_POLARITY_INVVD    AT91C_LCDC_INVVD_NORMALPOL
+/// LCDVSYNC polarity.
+#define BOARD_LCD_POLARITY_INVFRAME AT91C_LCDC_INVFRAME_INVERTEDPOL
+/// LCDHSYNC polarity.
+#define BOARD_LCD_POLARITY_INVLINE  AT91C_LCDC_INVLINE_INVERTEDPOL
+/// LCDDOTCLK polarity.
+#define BOARD_LCD_POLARITY_INVCLK   AT91C_LCDC_INVCLK_NORMALPOL
+/// LCDDEN polarity.
+#define BOARD_LCD_POLARITY_INVDVAL  AT91C_LCDC_INVDVAL_NORMALPOL
+/// Pixel clock mode.
+#define BOARD_LCD_CLOCKMODE         AT91C_LCDC_CLKMOD_ALWAYSACTIVE
+/// Vertical front porch in number of lines.
+#define BOARD_LCD_TIMING_VFP        4
+/// Vertical back porch in number of lines.
+#define BOARD_LCD_TIMING_VBP        4
+/// Vertical pulse width in LCDDOTCLK cycles.
+#define BOARD_LCD_TIMING_VPW        4
+/// Number of cycles between VSYNC edge and HSYNC rising edge.
+#define BOARD_LCD_TIMING_VHDLY      2
+/// Horizontal front porch in LCDDOTCLK cycles.
+#define BOARD_LCD_TIMING_HFP        5
+/// Horizontal back porch in LCDDOTCLK cycles.
+#define BOARD_LCD_TIMING_HBP        5
+/// Horizontal pulse width in LCDDOTCLK cycles.
+#define BOARD_LCD_TIMING_HPW        5
+
+/// Touchscreen ADC clock frequency to use.
+#define BOARD_TOUCHSCREEN_ADCCLK    300000 // 8MHz max
+/// Touchscreen ADC startup time in µseconds.
+#define BOARD_TOUCHSCREEN_STARTUP   40
+/// Touchscreen ADC track and hold time in nanoseconds.
+#define BOARD_TOUCHSCREEN_SHTIM     2000    // min 1µs at 8MHz
+/// Touchscreen pen debounce time in nanoseconds.
+#define BOARD_TOUCHSCREEN_DEBOUNCE  10000000
+
+/// Base address of the MCI peripheral connected to the SD card.
+#define BOARD_SD_MCI_BASE           AT91C_BASE_MCI0
+#if defined(ORIGIN_SD_PORT_MCI1)
+#undef BOARD_SD_MCI_BASE
+#define BOARD_SD_MCI_BASE           AT91C_BASE_MCI1
+#endif
+#define BOARD_SD_MCI1_BASE           AT91C_BASE_MCI1
+/// Dma channel number the mci is using
+#define BOARD_MCI_DMA_CHANNEL       0
+/// Peripheral identifier of the MCI connected to the SD card.
+#define BOARD_SD_MCI_ID             AT91C_ID_MCI0
+#if defined(ORIGIN_SD_PORT_MCI1)
+#undef BOARD_SD_MCI_ID
+#define BOARD_SD_MCI_ID             AT91C_ID_MCI1
+#endif
+#define BOARD_SD_MCI1_ID             AT91C_ID_MCI1
+/// MCI pins that shall be configured to access the SD card.
+#define BOARD_SD_PINS               PINS_MCI0
+#define BOARD_SD_DAT0               PIN_MCI0_DAT0
+#if defined(ORIGIN_SD_PORT_MCI1)
+#undef BOARD_SD_PINS
+#define BOARD_SD_PINS               PINS_MCI1
+#undef BOARD_SD_DAT0
+#define BOARD_SD_DAT0               PIN_MCI1_DAT0
+#endif
+#define BOARD_SD_MCI1_PINS          PINS_MCI1
+/// MCI slot to which the SD card is connected to.
+#define BOARD_SD_SLOT               MCI_SD_SLOTA
+#if defined(ORIGIN_SD_PORT_MCI1)
+#undef BOARD_SD_SLOT
+#define BOARD_SD_SLOT               MCI_SD_SLOTA  // MCI1 using MCI1's slotA
+#endif
+#define BOARD_SD_MCI1_SLOT          MCI_SD_SLOTA  // MCI1 using MCI1's slotA
+/// SD card write protection pin definition.
+//#define BOARD_SD_PIN_WP             PINS_MCI1_WP
+/// SD card detection pin definition.
+#define BOARD_SD_PIN_CD             PINS_MCI0_CD
+#if defined(ORIGIN_SD_PORT_MCI1)
+#undef BOARD_SD_PIN_CD
+#define BOARD_SD_PIN_CD             PINS_MCI1_CD
+#endif
+#define BOARD_SD_MCI1_PIN_CD             PINS_MCI1_CD
+/// MCI0 DMA hardware handshaking ID
+#define DMA_HW_SRC_REQ_ID_MCI0      AT91C_HDMA_SRC_PER_0
+#define DMA_HW_DEST_REQ_ID_MCI0     AT91C_HDMA_DST_PER_0
+/// MCI1 DMA hardware handshaking ID
+#define DMA_HW_SRC_REQ_ID_MCI1      AT91C_HDMA_SRC_PER_13
+#define DMA_HW_DEST_REQ_ID_MCI1     AT91C_HDMA_DST_PER_13
+/// SD DMA hardware handshaking ID
+#define BOARD_SD_DMA_HW_SRC_REQ_ID      DMA_HW_SRC_REQ_ID_MCI0
+#define BOARD_SD_DMA_HW_DEST_REQ_ID     DMA_HW_DEST_REQ_ID_MCI0
+#if defined(ORIGIN_SD_PORT_MCI1)
+#undef BOARD_SD_DMA_HW_SRC_REQ_ID
+#define BOARD_SD_DMA_HW_SRC_REQ_ID      DMA_HW_SRC_REQ_ID_MCI1
+#undef BOARD_SD_DMA_HW_DEST_REQ_ID
+#define BOARD_SD_DMA_HW_DEST_REQ_ID     DMA_HW_DEST_REQ_ID_MCI1
+#endif
+/// SD boot slot
+#define BOARD_SD_BOOT_MCISLOT    0
+
+/// PHY address
+#define BOARD_EMAC_PHY_ADDR         0
+/// PHY Component
+#define BOARD_EMAC_PHY_COMP_DM9161  1
+/// Board EMAC power control - ALWAYS ON
+#define BOARD_EMAC_POWER_ALWAYS_ON
+/// Board EMAC work mode - RMII/MII ( 1 / 0 )
+#define BOARD_EMAC_MODE_RMII        1
+/// The PIN list of PIO for EMAC
+#define BOARD_EMAC_PINS     {  (1<<27)|(1<<28)|(1<<29)|(1<<30)\
+                              |(1<< 6)|(1<< 7)|(1<< 8)|(1<< 9),\
+                              AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}, \
+                            {  (1<<10)|(1<<11)|(1<<12)|(1<<13)|(1<<14)|(1<<15)\
+                              |(1<<16)|(1<<17)|(1<<18)|(1<<19),\
+                              AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
+/// The power up reset latch PIO for PHY
+#define BOARD_EMAC_PIN_TEST   {(1<<15), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}//RX_DV
+#define BOARD_EMAC_PIN_RMII   {(1<<30), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}//COL
+// We force the address
+//(1<<12) RXD0/PHY address 0, (1<<13) RXD1/PHY address 1, (1<<8) RXD2/PHY address 2,
+//(1<<9) RXD3/PHY address 3, (1<<29) CRS/PHY address 4
+#define BOARD_EMAC_PINS_PHYAD {(1<<12)|(1<<13)|(1<<8)|(1<<9)|(1<<29),\
+                               AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
+#define BOARD_EMAC_PIN_10BT   {(1<<28), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}//RX_CLK
+#define BOARD_EMAC_PIN_RPTR   {(1<<16), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}//RX_ER/RXD4
+/// The PIN Configure list for EMAC on power up reset (RMII)
+#define BOARD_EMAC_RST_PINS BOARD_EMAC_PINS_PHYAD, \
+                            BOARD_EMAC_PIN_TEST, BOARD_EMAC_PIN_RMII, \
+                            BOARD_EMAC_PIN_10BT, BOARD_EMAC_PIN_RPTR
+/// The runtime pin configure list for EMAC
+#define BOARD_EMAC_RUN_PINS BOARD_EMAC_PINS
+
+/// AC97 pins definition.
+#define PINS_AC97   {(1<<6)|(1<<7)|(1<<8)|(1<<9),\
+                     AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_PERIPH_A, PIO_DEFAULT}
+
+/// ISI
+#define BOARD_ISI_V200
+#define BOARD_CAPTOR_OV2640
+#define BOARD_ISI_PIO_CTRL1 {(1<<12), AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_OUTPUT_0, PIO_DEFAULT}
+#define BOARD_ISI_PIO_CTRL2 {(1<<13), AT91C_BASE_PIOD, AT91C_ID_PIOD_E, PIO_OUTPUT_0, PIO_DEFAULT}
+#define BOARD_ISI_TWCK      {(1<<21), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
+#define BOARD_ISI_TWD       {(1<<20), AT91C_BASE_PIOA, AT91C_ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
+// PCK1 use instead of ISI_MCK
+#define BOARD_ISI_MCK       {(1<<31), AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_B, PIO_DEFAULT}
+#define BOARD_ISI_VSYNC     {(1<<29), AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+#define BOARD_ISI_HSYNC     {(1<<30), AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+#define BOARD_ISI_PCK       {(1<<28), AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT}
+#define BOARD_ISI_PINS_DATA {(1<<20)|(1<<21)|(1<<22)|(1<<23)|(1<<24)|(1<<25)|(1<<26)|(1<<27),\
+                             AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_A, PIO_DEFAULT},\
+                            {(1<<8)|(1<<9)|(1<<10)|(1<<11),\
+                             AT91C_BASE_PIOB, AT91C_ID_PIOB, PIO_PERIPH_B, PIO_DEFAULT}
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SAM9G45-EK - Memories"
+/// This page lists definitions related to external on-board memories.
+///
+/// !DDRAM
+/// - BOARD_DDRAM_SIZE
+/// - PINS_DDRAM
+/// - BOARD_DDRAM_BUSWIDTH
+/// - BOARD_SDRAM_BUSWIDTH
+///
+/// !Nandflash
+/// - PINS_NANDFLASH
+/// - BOARD_NF_EBI_COMMAND_ADDR
+/// - BOARD_NF_EBI_ADDRESS_ADDR
+/// - BOARD_NF_EBI_DATA_ADDR
+/// - BOARD_NF_CE_PIN
+/// - BOARD_NF_RB_PIN
+///
+/// !NorFlash
+/// - BOARD_NORFLASH_ADDR
+/// - BOARD_NORFLASH_DFT_BUS_SIZE
+
+/// Board DDRAM size
+#define BOARD_DDRAM_SIZE        (128*1024*1024)  // 128 MB
+/// List of all SDRAM pins definitions.
+#define PINS_DDRAM              {0xFFFF0000, AT91C_BASE_PIOC, AT91C_ID_PIOC, PIO_PERIPH_A, PIO_DEFAULT}
+/// DDRAM bus width.
+#define BOARD_DDRAM_BUSWIDTH    16
+/// SDRAM bus width.
+#define BOARD_SDRAM_BUSWIDTH    32
+
+/// Nandflash controller peripheral pins definition.
+#define PINS_NANDFLASH          BOARD_NF_CE_PIN, BOARD_NF_RB_PIN
+/// Nandflash chip enable pin definition.
+#define BOARD_NF_CE_PIN         {1 << 14, AT91C_BASE_PIOC, AT91C_ID_PIOC, PIO_OUTPUT_1, PIO_DEFAULT}
+/// Nandflash ready/busy pin definition.
+#define BOARD_NF_RB_PIN         {1 << 8, AT91C_BASE_PIOC, AT91C_ID_PIOC, PIO_INPUT, PIO_PULLUP}
+/// Address for transferring command bytes to the nandflash.
+#define BOARD_NF_COMMAND_ADDR   0x40400000
+/// Address for transferring address bytes to the nandflash.
+#define BOARD_NF_ADDRESS_ADDR   0x40200000
+/// Address for transferring data bytes to the nandflash.
+#define BOARD_NF_DATA_ADDR      0x40000000
+
+/// Address for transferring command bytes to the norflash.
+#define BOARD_NORFLASH_ADDR     0x10000000
+/// Default NOR bus size after power up reset
+#define BOARD_NORFLASH_DFT_BUS_SIZE 16
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SAM9G45-EK- Individual chip definition"
+/// This page lists the definitions related to different chip's definition
+/// located in the board.h file for the SAM9G45-EK.
+#define BOARD_RTC_ID                AT91C_ID_SYS
+
+/// Twi eeprom
+#define BOARD_ID_TWI_EEPROM         AT91C_ID_TWI0
+#define BOARD_BASE_TWI_EEPROM       AT91C_BASE_TWI0
+#define BOARD_PINS_TWI_EEPROM       PINS_TWI0
+
+/// USART
+#define BOARD_PIN_USART_RXD        PIN_USART1_RXD
+#define BOARD_PIN_USART_TXD        PIN_USART1_TXD
+#define BOARD_PIN_USART_CTS        PIN_USART1_CTS
+#define BOARD_PIN_USART_RTS        PIN_USART1_RTS
+#define BOARD_USART_BASE           AT91C_BASE_US1
+#define BOARD_ID_USART             AT91C_ID_US1
+//------------------------------------------------------------------------------
+
+#endif //#ifndef BOARD_H
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board.mak b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board.mak
new file mode 100644
index 0000000000000000000000000000000000000000..071893b81eb24c110be3d193092986924263de4e
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board.mak
@@ -0,0 +1,32 @@
+# ----------------------------------------------------------------------------
+#         ATMEL Microcontroller Software Support 
+# ----------------------------------------------------------------------------
+# Copyright (c) 2008, Atmel Corporation
+#
+# All rights reserved.
+#
+# Redistribution and use in source and binary forms, with or without
+# modification, are permitted provided that the following conditions are met:
+#
+# - Redistributions of source code must retain the above copyright notice,
+# this list of conditions and the disclaimer below.
+#
+# Atmel's name may not be used to endorse or promote products derived from
+# this software without specific prior written permission.
+#
+# DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+# MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+# DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+# LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+# OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+# LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+# NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+# EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+# ----------------------------------------------------------------------------
+
+# Defines which are the available memory targets for the AT91SAM9G45-EK board.
+
+MEMORIES = ddram sram
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup.S b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup.S
new file mode 100644
index 0000000000000000000000000000000000000000..1775b057cd086190383cbcecf5e28d0aceb3d92e
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup.S
@@ -0,0 +1,191 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "board.h"
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+#define IRQ_STACK_SIZE   8*3*4
+
+#define ARM_MODE_ABT     0x17
+#define ARM_MODE_FIQ     0x11
+#define ARM_MODE_IRQ     0x12
+#define ARM_MODE_SVC     0x13
+
+#define I_BIT            0x80
+#define F_BIT            0x40
+
+//------------------------------------------------------------------------------
+//         Startup routine
+//------------------------------------------------------------------------------
+
+            .align      4
+            .arm
+        
+/* Exception vectors
+ *******************/
+            .section    .vectors, "a", %progbits
+
+resetVector:
+        ldr     pc, =resetHandler       /* Reset */
+undefVector:
+        b       undefVector             /* Undefined instruction */
+swiVector:
+        b       swiVector               /* Software interrupt */
+prefetchAbortVector:
+        b       prefetchAbortVector     /* Prefetch abort */
+dataAbortVector:
+        b       dataAbortVector         /* Data abort */
+reservedVector:
+        b       reservedVector          /* Reserved for future use */
+irqVector:
+        b       irqHandler              /* Interrupt */
+fiqVector:
+                                        /* Fast interrupt */
+//------------------------------------------------------------------------------
+/// Handles a fast interrupt request by branching to the address defined in the
+/// AIC.
+//------------------------------------------------------------------------------
+fiqHandler:
+        b       fiqHandler
+	
+//------------------------------------------------------------------------------
+/// Handles incoming interrupt requests by branching to the corresponding
+/// handler, as defined in the AIC. Supports interrupt nesting.
+//------------------------------------------------------------------------------
+irqHandler:
+
+/* Save interrupt context on the stack to allow nesting */
+        sub     lr, lr, #4
+        stmfd   sp!, {lr}
+        mrs     lr, SPSR
+        stmfd   sp!, {r0, lr}
+
+/* Write in the IVR to support Protect Mode */
+        ldr     lr, =AT91C_BASE_AIC
+        ldr     r0, [lr, #AIC_IVR]
+        str     lr, [lr, #AIC_IVR]
+
+/* Branch to interrupt handler in Supervisor mode */
+        msr     CPSR_c, #ARM_MODE_SVC
+        stmfd   sp!, {r1-r3, r4, r12, lr}
+        blx     r0
+        
+/* Restore scratch/used registers and LR from User Stack */
+/* Disable Interrupt and switch back in IRQ mode */      
+        ldmia   sp!, {r1-r3, r4, r12, lr}
+        msr     CPSR_c, #ARM_MODE_IRQ | I_BIT
+
+/* Acknowledge interrupt */
+        ldr     lr, =AT91C_BASE_AIC
+        str     lr, [lr, #AIC_EOICR]
+
+/* Restore interrupt context and branch back to calling code */
+        ldmia   sp!, {r0, lr}
+        msr     SPSR_cxsf, lr
+        ldmia   sp!, {pc}^
+
+//------------------------------------------------------------------------------
+/// Initializes the chip and branches to the main() function.
+//------------------------------------------------------------------------------
+            .section    .text
+            .global     entry
+
+entry:
+resetHandler:
+
+/* Useless instruction for referencing the .vectors section */
+        ldr     r0, =resetVector
+
+/* Set pc to actual code location (i.e. not in remap zone) */
+	    ldr     pc, =1f
+
+/* Initialize the prerelocate segment */
+1:
+        ldr     r0, =_efixed
+        ldr     r1, =_sprerelocate
+        ldr     r2, =_eprerelocate
+1:
+        cmp     r1, r2
+        ldrcc   r3, [r0], #4
+        strcc   r3, [r1], #4
+        bcc     1b
+
+/* Perform low-level initialization of the chip using LowLevelInit() */
+        ldr     sp, =_sstack
+        stmfd   sp!, {r0}
+	    ldr     r0, =LowLevelInit
+        blx     r0
+
+/* Initialize the postrelocate segment */
+
+        ldmfd   sp!, {r0}
+        ldr     r1, =_spostrelocate
+        ldr     r2, =_epostrelocate
+1:
+        cmp     r1, r2
+        ldrcc   r3, [r0], #4
+        strcc   r3, [r1], #4
+        bcc     1b
+
+/* Clear the zero segment */
+	    ldr     r0, =_szero
+        ldr     r1, =_ezero
+        mov     r2, #0
+1:
+        cmp     r0, r1
+        strcc   r2, [r0], #4
+        bcc     1b
+
+/* Setup stacks
+ **************/
+/* IRQ mode */
+        msr     CPSR_c, #ARM_MODE_IRQ | I_BIT | F_BIT
+        ldr     sp, =_sstack
+        sub     r4, sp, #IRQ_STACK_SIZE
+
+/* Supervisor mode (interrupts enabled) */
+        msr     CPSR_c, #ARM_MODE_SVC | F_BIT
+        mov     sp, r4
+
+/* Branch to main()
+ ******************/
+        ldr     r0, =main
+        blx     r0
+
+/* Loop indefinitely when program is finished */
+1:
+        b       1b
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup_iar.s b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup_iar.s
new file mode 100644
index 0000000000000000000000000000000000000000..8f848f9aab425c1f31228dab942f9830d5c9d592
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup_iar.s
@@ -0,0 +1,187 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+/*
+     IAR startup file for AT91SAM9G45 microcontrollers.
+ */
+
+        MODULE  ?cstartup
+
+        ;; Forward declaration of sections.
+        SECTION IRQ_STACK:DATA:NOROOT(2)
+        SECTION CSTACK:DATA:NOROOT(3)
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#define __ASSEMBLY__
+#include "board.h"
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+#define ARM_MODE_ABT     0x17
+#define ARM_MODE_FIQ     0x11
+#define ARM_MODE_IRQ     0x12
+#define ARM_MODE_SVC     0x13
+#define ARM_MODE_SYS     0x1F
+
+#define I_BIT            0x80
+#define F_BIT            0x40
+
+//------------------------------------------------------------------------------
+//         Startup routine
+//------------------------------------------------------------------------------
+
+/*
+   Exception vectors
+ */
+        SECTION .vectors:CODE:NOROOT(2)
+
+        PUBLIC  resetVector
+        PUBLIC  irqHandler
+
+        EXTERN  Undefined_Handler
+        EXTERN  SWI_Handler
+        EXTERN  Prefetch_Handler
+        EXTERN  Abort_Handler
+        EXTERN  FIQ_Handler
+
+        ARM
+
+__iar_init$$done:               ; The interrupt vector is not needed
+                                ; until after copy initialization is done
+
+resetVector:
+        ; All default exception handlers (except reset) are
+        ; defined as weak symbol definitions.
+        ; If a handler is defined by the application it will take precedence.
+        LDR     pc, =resetHandler        ; Reset
+        LDR     pc, Undefined_Addr       ; Undefined instructions
+        LDR     pc, SWI_Addr             ; Software interrupt (SWI/SYS)
+        LDR     pc, Prefetch_Addr        ; Prefetch abort
+        LDR     pc, Abort_Addr           ; Data abort
+        B       .                        ; RESERVED
+        LDR     pc, =irqHandler          ; IRQ
+        LDR     pc, FIQ_Addr             ; FIQ
+
+Undefined_Addr: DCD   Undefined_Handler
+SWI_Addr:       DCD   SWI_Handler
+Prefetch_Addr:  DCD   Prefetch_Handler
+Abort_Addr:     DCD   Abort_Handler
+FIQ_Addr:       DCD   FIQ_Handler
+	
+/*
+   Handles incoming interrupt requests by branching to the corresponding
+   handler, as defined in the AIC. Supports interrupt nesting.
+ */
+irqHandler:
+        /* Save interrupt context on the stack to allow nesting */
+        SUB     lr, lr, #4
+        STMFD   sp!, {lr}
+        MRS     lr, SPSR
+        STMFD   sp!, {r0, lr}
+
+        /* Write in the IVR to support Protect Mode */
+        LDR     lr, =AT91C_BASE_AIC
+        LDR     r0, [r14, #AIC_IVR]
+        STR     lr, [r14, #AIC_IVR]
+
+        /* Branch to interrupt handler in Supervisor mode */
+        MSR     CPSR_c, #ARM_MODE_SYS
+        STMFD   sp!, {r1-r3, r4, r12, lr}
+
+        /* Check for 8-byte alignment and save lr plus a */
+        /* word to indicate the stack adjustment used (0 or 4) */
+        AND     r1, sp, #4
+        SUB     sp, sp, r1
+        STMFD   sp!, {r1, lr}
+
+        BLX     r0
+
+        LDMIA   sp!, {r1, lr}
+        ADD     sp, sp, r1
+
+        LDMIA   sp!, {r1-r3, r4, r12, lr}
+        MSR     CPSR_c, #ARM_MODE_IRQ | I_BIT
+
+        /* Acknowledge interrupt */
+        LDR     lr, =AT91C_BASE_AIC
+        STR     lr, [r14, #AIC_EOICR]
+
+        /* Restore interrupt context and branch back to calling code */
+        LDMIA   sp!, {r0, lr}
+        MSR     SPSR_cxsf, lr
+        LDMIA   sp!, {pc}^
+
+
+/*
+   After a reset, execution starts here, the mode is ARM, supervisor
+   with interrupts disabled.
+   Initializes the chip and branches to the main() function.
+ */
+        SECTION .cstartup:CODE:NOROOT(2)
+
+        PUBLIC  resetHandler
+        EXTERN  LowLevelInit
+        EXTERN  ?main
+        REQUIRE resetVector
+        ARM
+
+resetHandler:
+
+        /* Set pc to actual code location (i.e. not in remap zone) */
+	    LDR     pc, =label
+
+        /* Perform low-level initialization of the chip using LowLevelInit() */
+label:
+	    LDR     r0, =LowLevelInit
+        LDR     r4, =SFE(CSTACK)
+        MOV     sp, r4
+        BLX     r0
+
+        /* Set up the interrupt stack pointer. */
+        MSR     cpsr_c, #ARM_MODE_IRQ | I_BIT | F_BIT      ; Change the mode
+        LDR     sp, =SFE(IRQ_STACK)
+
+        /* Set up the SYS stack pointer. */
+        MSR     cpsr_c, #ARM_MODE_SYS | F_BIT              ; Change the mode
+        LDR     sp, =SFE(CSTACK)
+
+        /* Branch to main() */
+        LDR     r0, =?main
+        BLX     r0
+
+        /* Loop indefinitely when program is finished */
+loop4:
+        B       loop4
+
+        END
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup_keil.s b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup_keil.s
new file mode 100644
index 0000000000000000000000000000000000000000..1014db8acdfb514c15f5e9df062ebbcec1994b29
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_cstartup_keil.s
@@ -0,0 +1,208 @@
+; * ----------------------------------------------------------------------------
+; *         ATMEL Microcontroller Software Support 
+; * ----------------------------------------------------------------------------
+; * Copyright (c) 2008, Atmel Corporation
+; *
+; * All rights reserved.
+; *
+; * Redistribution and use in source and binary forms, with or without
+; * modification, are permitted provided that the following conditions are met:
+; *
+; * - Redistributions of source code must retain the above copyright notice,
+; * this list of conditions and the disclaimer below.
+; *
+; * Atmel's name may not be used to endorse or promote products derived from
+; * this software without specific prior written permission.
+; *
+; * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+; * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+; * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+; * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+; * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+; * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+; * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+; * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+; * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+; * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+; * ----------------------------------------------------------------------------
+
+
+;     KEIL startup file for AT91SAM9G45 microcontrollers.
+
+; ------------------------------------------------------------------------------
+;          Definitions
+; ------------------------------------------------------------------------------
+
+; Standard definitions of Mode bits and Interrupt (I & F) flags in PSRs
+
+ARM_MODE_USR        EQU     0x10
+ARM_MODE_FIQ        EQU     0x11
+ARM_MODE_IRQ        EQU     0x12
+ARM_MODE_SVC        EQU     0x13
+ARM_MODE_ABT        EQU     0x17
+ARM_MODE_UND        EQU     0x1B
+ARM_MODE_SYS        EQU     0x1F
+
+I_BIT               EQU     0x80            ; when I bit is set, IRQ is disabled
+F_BIT               EQU     0x40            ; when F bit is set, FIQ is disabled
+
+AT91C_BASE_AIC      EQU     0xFFFFF000
+AIC_IVR             EQU     0x100
+AIC_EOICR           EQU     0x130
+
+UND_Stack_Size      EQU     0x00000000
+SVC_Stack_Size      EQU     0x00000100
+ABT_Stack_Size      EQU     0x00000000
+FIQ_Stack_Size      EQU     0x00000000
+IRQ_Stack_Size      EQU     0x00000080
+USR_Stack_Size      EQU     0x00000400
+
+        PRESERVE8
+
+; Area Definition and Entry Point
+; Startup Code must be linked first at Address at which it expects to run.
+
+        AREA    VECTOR, CODE
+        ARM
+
+; Exception Vectors
+
+Vectors         
+				LDR     pc,=resetHandler 
+undefVector  
+			    b   	undefVector             ; Undefined instruction
+swiVector
+        		b       swiVector               ; Software interrupt
+prefetchAbortVector
+        		b       prefetchAbortVector     ; Prefetch abort
+dataAbortVector
+        		b       dataAbortVector         ; Data abort
+reservedVector
+        		b       reservedVector          ; Reserved for future use
+irqVector
+        b       irqHandler              ; Interrupt
+fiqVector
+                                        ; Fast interrupt
+	
+;------------------------------------------------------------------------------
+; Handles a fast interrupt request by branching to the address defined in the
+; AIC.
+;------------------------------------------------------------------------------
+fiqHandler
+        b       fiqHandler
+	
+;------------------------------------------------------------------------------
+; Handles incoming interrupt requests by branching to the corresponding
+; handler, as defined in the AIC. Supports interrupt nesting.
+;------------------------------------------------------------------------------
+irqHandler
+        ;  Save interrupt context on the stack to allow nesting */
+        SUB     lr, lr, #4
+        STMFD   sp!, {lr}
+        MRS     lr, SPSR
+        STMFD   sp!, {r0,r1,lr}
+
+        ; Write in the IVR to support Protect Mode */
+        LDR     lr, =AT91C_BASE_AIC
+        LDR     r0, [r14, #AIC_IVR]
+        STR     lr, [r14, #AIC_IVR]
+
+        ; Branch to interrupt handler in Supervisor mode */
+        MSR     CPSR_c, #ARM_MODE_SVC
+        STMFD   sp!, {r1-r4, r12, lr}
+        MOV     lr, pc
+        BX      r0
+        LDMIA   sp!, {r1-r4, r12, lr}
+        MSR     CPSR_c, #ARM_MODE_IRQ | I_BIT
+
+        ; Acknowledge interrupt */
+        LDR     lr, =AT91C_BASE_AIC
+        STR     lr, [r14, #AIC_EOICR]
+
+        ; Restore interrupt context and branch back to calling code
+        LDMIA   sp!, {r0,r1,lr}
+        MSR     SPSR_cxsf, lr
+        LDMIA   sp!, {pc}^
+
+;------------------------------------------------------------------------------
+; After a reset, execution starts here, the mode is ARM, supervisor
+; with interrupts disabled.
+; Initializes the chip and branches to the main() function.
+;------------------------------------------------------------------------------
+                
+   		AREA  cstartup, CODE
+   		ENTRY        ; Entry point for the application
+   		
+   		
+; Reset Handler
+
+        EXPORT  resetHandler
+        IMPORT	|Image$$Fixed_region$$Limit|
+        IMPORT  |Image$$Relocate_region$$Base|
+        IMPORT  |Image$$Relocate_region$$ZI$$Base|
+        IMPORT  |Image$$Relocate_region$$ZI$$Limit|
+        IMPORT  |Image$$ARM_LIB_STACK$$Base|
+        IMPORT  |Image$$ARM_LIB_STACK$$ZI$$Limit|
+        
+		; Perform low-level initialization of the chip using LowLevelInit()
+		IMPORT  LowLevelInit
+		
+resetHandler   
+        
+        ; Set pc to actual code location (i.e. not in remap zone)
+	    LDR     pc, =label
+label	    
+		; Set up temporary stack (Top of the SRAM)
+		LDR     r0, = |Image$$ARM_LIB_STACK$$ZI$$Limit|
+        MOV     sp, r0
+		; Call Low level init
+	    LDR     r0, =LowLevelInit
+        MOV     lr, pc
+        BX      r0
+
+
+;Initialize the Relocate_region segment 
+		LDR 	r0, = |Image$$Fixed_region$$Limit|
+		LDR 	r1, = |Image$$Relocate_region$$Base|
+		LDR 	r3, = |Image$$Relocate_region$$ZI$$Base|
+	    
+	    CMP     r0, r1                 
+     	BEQ     %1
+     	
+     	
+        ; Copy init data
+0       CMP     r1, r3         
+        LDRCC   r2, [r0], #4   
+        STRCC   r2, [r1], #4
+        BCC     %0
+
+1       LDR     r1, =|Image$$Relocate_region$$ZI$$Limit|
+        MOV     r2, #0
+2       CMP     r3, r1                  
+        STRCC   r2, [r3], #4
+        BCC     %2
+       
+               
+; Setup Stack for each mode
+
+        LDR     R0, = |Image$$ARM_LIB_STACK$$ZI$$Limit|
+
+;  Enter IRQ Mode and set its Stack Pointer
+        MSR     CPSR_c, #ARM_MODE_IRQ:OR:I_BIT:OR:F_BIT
+        MOV     SP, R0
+        SUB     R4, SP, #IRQ_Stack_Size
+
+; Supervisor mode (interrupts enabled) 
+        MSR     CPSR_c, #ARM_MODE_SVC | F_BIT
+        MOV     SP, R4         
+
+; Enter the C code
+
+        IMPORT  __main
+        LDR     R0, =__main
+        BX      R0
+loop4
+        B       loop4                
+
+        END
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_lowlevel.c b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_lowlevel.c
new file mode 100644
index 0000000000000000000000000000000000000000..703bd9ef5a31b0179fb00d6aa96e5d5797b2fa53
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_lowlevel.c
@@ -0,0 +1,180 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+///
+/// Provides the low-level initialization function that gets called on chip
+/// startup.
+///
+/// !Usage
+///
+/// LowLevelInit() is called in #board_cstartup.S#.
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "board.h"
+#include "board_memories.h"
+#include <pmc/pmc.h>
+
+//------------------------------------------------------------------------------
+//         Internal definitions
+//------------------------------------------------------------------------------
+
+/* Settings at 400/133MHz */
+#define BOARD_OSCOUNT           (AT91C_CKGR_OSCOUNT & (64 << 8))
+#define BOARD_CKGR_PLLA         (AT91C_CKGR_SRCA | AT91C_CKGR_OUTA_0)
+#define BOARD_PLLACOUNT         (0x3F << 8)
+#define BOARD_MULA              (AT91C_CKGR_MULA & (199 << 16))
+#define BOARD_DIVA              (AT91C_CKGR_DIVA & 3)
+
+//#define BOARD_PRESCALER         (0x00001300) //400/133MHz
+#define BOARD_PRESCALER         (0x00001200) //400/100MHz
+
+//------------------------------------------------------------------------------
+//         Internal functions
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+/// Default spurious interrupt handler. Infinite loop.
+//------------------------------------------------------------------------------
+void defaultSpuriousHandler( void )
+{
+    while (1);
+}
+
+//------------------------------------------------------------------------------
+/// Default handler for fast interrupt requests. Infinite loop.
+//------------------------------------------------------------------------------
+void defaultFiqHandler( void )
+{
+    while (1);
+}
+
+//------------------------------------------------------------------------------
+/// Default handler for standard interrupt requests. Infinite loop.
+//------------------------------------------------------------------------------
+void defaultIrqHandler( void )
+{
+    while (1);
+}
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+/// Performs the low-level initialization of the chip. Initialisation depends
+/// on where the application is executed: 
+/// - in sdram: it means that sdram has previously been initialized. No further
+///             initialization is required.
+/// - in sram:  PLL shall be initialized in LowLevelInit. Other initializations 
+///             can be done later by the application.
+/// - in norflash: LowLevelInit can't be executed in norflash because SMC 
+///             settings can't be changed while executing in external flash.
+///             LowLevelInit shall be executed in internal sram. It initializes
+///             PLL and SMC. 
+/// This function also reset the AIC and disable RTT and PIT interrupts
+//------------------------------------------------------------------------------
+void LowLevelInit(void)
+{
+    unsigned char i;
+
+#if !defined(ddram)
+
+for(i=0;i<3;i++) /* it seems that the PLL doesn't start up propely the 1st time it's programmed */
+{
+    /* Initialize main oscillator    
+     ****************************/
+    AT91C_BASE_PMC->PMC_MOR = BOARD_OSCOUNT | AT91C_CKGR_MOSCEN;
+    while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MOSCS));
+
+    /* Initialize PLLA */
+    AT91C_BASE_PMC->PMC_PLLAR = BOARD_CKGR_PLLA
+                                | BOARD_PLLACOUNT
+                                | BOARD_MULA
+                                | BOARD_DIVA;
+    while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_LOCKA));
+    
+    /* Wait for the master clock if it was already initialized */
+    while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY));
+
+    /* Switch to fast clock
+     **********************/
+    /* Switch to main oscillator + prescaler */
+    AT91C_BASE_PMC->PMC_MCKR = (AT91C_BASE_PMC->PMC_MCKR & 0x3) | BOARD_PRESCALER;
+    while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY));
+
+    /* Switch to PLL + prescaler */
+    AT91C_BASE_PMC->PMC_MCKR = (AT91C_BASE_PMC->PMC_MCKR & 0xfffffffc) | AT91C_PMC_CSS_PLLA_CLK;
+    while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY));
+}
+#endif
+
+    /* Initialize AIC
+     ****************/
+    AT91C_BASE_AIC->AIC_IDCR = 0xFFFFFFFF;
+    AT91C_BASE_AIC->AIC_SVR[0] = (unsigned int) defaultFiqHandler;
+    for (i = 1; i < 31; i++) {
+
+        AT91C_BASE_AIC->AIC_SVR[i] = (unsigned int) defaultIrqHandler;
+    }
+    AT91C_BASE_AIC->AIC_SPU = (unsigned int) defaultSpuriousHandler;
+
+    // Unstack nested interrupts
+    for (i = 0; i < 8 ; i++) {
+
+        AT91C_BASE_AIC->AIC_EOICR = 0;
+    }
+
+
+    /* Watchdog initialization
+     *************************/
+  #ifndef WDT_APP // Watchdog init in application ?
+    AT91C_BASE_WDTC->WDTC_WDMR = AT91C_WDTC_WDDIS;
+  #endif
+
+    /* Remap
+     *******/
+    BOARD_RemapRam();
+
+    // Disable RTT and PIT interrupts (potential problem when program A
+    // configures RTT, then program B wants to use PIT only, interrupts
+    // from the RTT will still occur since they both use AT91C_ID_SYS)
+    AT91C_BASE_RTTC->RTTC_RTMR &= ~(AT91C_RTTC_ALMIEN | AT91C_RTTC_RTTINCIEN);
+    AT91C_BASE_PITC->PITC_PIMR &= ~AT91C_PITC_PITIEN;
+    
+#if defined(norflash)
+    BOARD_ConfigureNorFlash(BOARD_NORFLASH_DFT_BUS_SIZE);
+#endif    
+}
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_lowlevel.h b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_lowlevel.h
new file mode 100644
index 0000000000000000000000000000000000000000..fdffcb08152b17ab5d1fb42af216332a8cef9af2
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_lowlevel.h
@@ -0,0 +1,53 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+///
+/// Provides the low-level initialization function that gets called on chip
+/// startup.
+///
+/// !Usage
+///
+/// LowLevelInit() is called in #board_cstartup.S#.
+//------------------------------------------------------------------------------
+
+#ifndef BOARD_LOWLEVEL_H
+#define BOARD_LOWLEVEL_H
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+extern void LowLevelInit(void);
+
+#endif // BOARD_LOWLEVEL_H
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_memories.c b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_memories.c
new file mode 100644
index 0000000000000000000000000000000000000000..d179f5c1b28b370d21479c4eec35b6e658fef248
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_memories.c
@@ -0,0 +1,547 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+/*
+    Title: Memories implementation
+*/
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+#include <pio/pio.h>
+#include "board_memories.h"
+
+/*
+    Macros:
+        READ - Reads a register value. Useful to add trace information to read
+               accesses.
+        WRITE - Writes data in a register. Useful to add trace information to
+                write accesses.
+*/
+#define READ(peripheral, register)          (peripheral->register)
+#define WRITE(peripheral, register, value)  (peripheral->register = value)
+
+
+//------------------------------------------------------------------------------
+//         Internal functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+/// Changes the mapping of the chip so that the remap area mirrors the
+///   internal ROM or the EBI CS0.
+//------------------------------------------------------------------------------
+void BOARD_RemapRom()
+{
+    WRITE(AT91C_BASE_MATRIX, MATRIX_MRCR, 0);
+}
+
+//------------------------------------------------------------------------------
+/// Changes the mapping of the chip so that the remap area mirrors the
+///   internal RAM.
+//------------------------------------------------------------------------------
+void BOARD_RemapRam()
+{
+    WRITE(AT91C_BASE_MATRIX,
+          MATRIX_MRCR,
+          (AT91C_MATRIX_RCA926I | AT91C_MATRIX_RCA926D));
+}
+
+
+
+void BOARD_ConfigureVddMemSel(unsigned char VddMemSel)
+{
+
+    if (VddMemSel == VDDMEMSEL_3V3) {
+            AT91C_BASE_MATRIX->MATRIX_EBICSA |= (1 << 16);
+                    AT91C_BASE_MATRIX->MATRIX_EBICSA &= ~(1 << 17);
+                        }
+                            else {
+                                    AT91C_BASE_MATRIX->MATRIX_EBICSA &= ~(1 << 16);
+                                            AT91C_BASE_MATRIX->MATRIX_EBICSA &= ~(1 << 17);
+                                                }
+                                                }
+                                                
+//------------------------------------------------------------------------------
+/// Configure DDR
+//------------------------------------------------------------------------------
+void BOARD_ConfigureDdram(unsigned char ddrModel, unsigned char busWidth)
+{    
+    AT91PS_HDDRSDRC2 pDdrc = AT91C_BASE_DDR2C;
+    volatile unsigned int *pDdr = (unsigned int *) AT91C_DDR2;
+    int i;
+    volatile unsigned int cr = 0;
+    unsigned short ddrc_dbw = 0;
+
+    switch (busWidth) {
+        case 16:
+        default:
+            ddrc_dbw = AT91C_DDRC2_DBW_16_BITS;
+            break;
+
+        case 32:
+            ddrc_dbw = AT91C_DDRC2_DBW_32_BITS;
+            break;
+
+    }
+
+    // Enable DDR2 clock x2 in PMC
+    WRITE(AT91C_BASE_PMC, PMC_SCER, AT91C_PMC_DDR);
+
+    // Disable anticipated read
+    WRITE(pDdrc, HDDRSDRC2_HS, (READ(pDdrc, HDDRSDRC2_HS) | AT91C_DDRC2_NO_ANT));
+
+    switch (ddrModel) {
+
+        case DDR_MICRON_MT47H64M8: 
+            // Step 1: Program the memory device type
+            WRITE(pDdrc, HDDRSDRC2_MDR, ddrc_dbw   |
+                                        AT91C_DDRC2_MD_DDR2_SDRAM);     // DDR2
+            
+            // Step 2:                            
+            // 1. Program the features of DDR2-SDRAM device into the Configuration Register.                    
+            // 2. Program the features of DDR2-SDRAM device into the Timing Register HDDRSDRC2_T0PR.            
+            // 3. Program the features of DDR2-SDRAM device into the Timing Register HDDRSDRC2_T1PR.            
+            // 4. Program the features of DDR2-SDRAM device into the Timing Register HDDRSDRC2_T2PR.            
+
+            WRITE(pDdrc, HDDRSDRC2_CR, AT91C_DDRC2_NC_DDR10_SDR9  |     // 10 column bits (1K)
+                                       AT91C_DDRC2_NR_14          |     // 14 row bits    (8K)
+                                       AT91C_DDRC2_CAS_3          |     // CAS Latency 3
+                                       AT91C_DDRC2_DLL_RESET_DISABLED
+                                       ); // DLL not reset
+
+            // assume timings for 7.5ns min clock period
+            WRITE(pDdrc, HDDRSDRC2_T0PR, AT91C_DDRC2_TRAS_6       |     //  6 * 7.5 = 45 ns
+                                         AT91C_DDRC2_TRCD_2       |     //  2 * 7.5 = 15 ns
+                                         AT91C_DDRC2_TWR_2        |     //  2 * 7.5 = 15 ns
+                                         AT91C_DDRC2_TRC_8        |     //  8 * 7.5 = 60 ns
+                                         AT91C_DDRC2_TRP_2        |     //  2 * 7.5 = 15 ns
+                                         AT91C_DDRC2_TRRD_1       |     //  1 * 7.5 = 7.5 ns
+                                         AT91C_DDRC2_TWTR_1       |     //  1 clock cycle
+                                         AT91C_DDRC2_TMRD_2);           //  2 clock cycles
+
+            WRITE(pDdrc, HDDRSDRC2_T1PR, AT91C_DDRC2_TXP_2  |           //  2 * 7.5 = 15 ns
+                                         200 << 16          |           // 200 clock cycles, TXSRD: Exit self refresh delay to Read command
+                                         16 << 8            |           // 16 * 7.5 = 120 ns TXSNR: Exit self refresh delay to non read command
+                                         AT91C_DDRC2_TRFC_14 << 0);     // 14 * 7.5 = 105 ns (must be 105 ns for 512M DDR)
+
+            WRITE(pDdrc, HDDRSDRC2_T2PR, AT91C_DDRC2_TRTP_1   |         //  1 * 7.5 = 7.5 ns
+                                         AT91C_DDRC2_TRPA_0   |         
+                                         AT91C_DDRC2_TXARDS_7 |         //  7 clock cycles
+                                         AT91C_DDRC2_TXARD_2);          //  2 clock cycles
+
+            // Step 3: An NOP command is issued to the DDR2-SDRAM to enable clock.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+            *pDdr = 0;
+ 
+            // Initialization Step 3 (must wait 200 us) (6 core cycles per iteration, core is at 396MHz: min 13200 loops)
+            for (i = 0; i < 13300; i++) {
+                asm("    nop");
+            }
+            // Step 4:  An NOP command is issued to the DDR2-SDRAM 
+            // NOP command -> allow to enable cke
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+            *pDdr = 0;
+            
+            // wait 400 ns min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+
+            // Step 5: An all banks precharge command is issued to the DDR2-SDRAM.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+            *pDdr = 0;
+            
+            // wait 400 ns min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+
+            // Step 6: An Extended Mode Register set (EMRS2) cycle is  issued to chose between commercialor high  temperature operations.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x4000000)) = 0;
+         
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 7: An Extended Mode Register set (EMRS3) cycle is issued to set all registers to 0.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x6000000)) = 0;
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+             
+            // Step 8:  An Extended Mode Register set (EMRS1) cycle is issued to enable DLL.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x2000000)) = 0;
+
+            // wait 200 cycles min
+            for (i = 0; i < 10000; i++) {
+                asm("    nop");
+            }
+            
+            // Step 9:  Program DLL field into the Configuration Register.
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr | AT91C_DDRC2_DLL_RESET_ENABLED);
+            
+            // Step 10: A Mode Register set (MRS) cycle is issued to reset DLL.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_LMR_CMD);
+            *(pDdr) = 0;
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 11: An all banks precharge command is issued to the DDR2-SDRAM.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+            *(pDdr) = 0;
+
+            // wait 400 ns min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+
+            // Step 12: Two auto-refresh (CBR) cycles are provided. Program the auto refresh command (CBR) into the Mode Register.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+            *(pDdr) = 0;
+
+            // wait 10 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            // Set 2nd CBR
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+            *(pDdr) = 0;
+
+            // wait 10 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 13: Program DLL field into the Configuration Register to low(Disable DLL reset).
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_DLL_RESET_ENABLED));
+            
+            // Step 14: A Mode Register set (MRS) cycle is issued to program the parameters of the DDR2-SDRAM devices.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_LMR_CMD);
+            *(pDdr) = 0;
+    
+            // Step 15: Program OCD field into the Configuration Register to high (OCD calibration default).
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr | AT91C_DDRC2_OCD_DEFAULT);
+            
+            // Step 16: An Extended Mode Register set (EMRS1) cycle is issued to OCD default value.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x2000000)) = 0;
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 17: Program OCD field into the Configuration Register to low (OCD calibration mode exit).
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_OCD_EXIT));
+         
+           // Step 18: An Extended Mode Register set (EMRS1) cycle is issued to enable OCD exit.
+           WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x6000000)) = 0;
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 19,20: A mode Normal command is provided. Program the Normal mode into Mode Register.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NORMAL_CMD);
+            *(pDdr) = 0;
+
+            // Step 21: Write the refresh rate into the count field in the Refresh Timer register. The DDR2-SDRAM device requires a
+            // refresh every 15.625 ¦Ìs or 7.81 ¦Ìs. With a 100MHz frequency, the refresh timer count register must to be set with
+            // (15.625 /100 MHz) = 1562 i.e. 0x061A or (7.81 /100MHz) = 781 i.e. 0x030d.
+      
+            // Set Refresh timer
+            WRITE(pDdrc, HDDRSDRC2_RTR, 0x00000411);
+
+            // Read optimization" shall be un-selected on this revision.
+            WRITE(pDdrc, HDDRSDRC2_HS, 0x4);
+
+            // OK now we are ready to work on the DDRSDR
+
+            // wait for end of calibration
+            for (i = 0; i < 500; i++) {
+                asm("    nop");
+            }
+
+            break;
+
+
+        case DDR_SAMSUNG_M470T6554EZ3_CE6:
+
+             // Step 1: Program the memory device type
+            WRITE(pDdrc, HDDRSDRC2_MDR, ddrc_dbw   |
+                                        AT91C_DDRC2_MD_DDR2_SDRAM);     // DDR2
+            
+            // Step 2:                            
+            // 1. Program the features of DDR2-SDRAM device into the Configuration Register.                    
+            // 2. Program the features of DDR2-SDRAM device into the Timing Register HDDRSDRC2_T0PR.            
+            // 3. Program the features of DDR2-SDRAM device into the Timing Register HDDRSDRC2_T1PR.            
+            // 4. Program the features of DDR2-SDRAM device into the Timing Register HDDRSDRC2_T2PR.            
+            WRITE(pDdrc, HDDRSDRC2_CR, AT91C_DDRC2_NC_DDR10_SDR9  |     // 10 column bits (1K)
+                                       AT91C_DDRC2_NR_13          |     // 13 row bits    (8K)
+                                       AT91C_DDRC2_CAS_3          |     // CAS Latency 3
+                                       AT91C_DDRC2_DLL_RESET_DISABLED); // DLL not reset
+          
+          // assume timings for 7.5ns min clock period
+            WRITE(pDdrc, HDDRSDRC2_T0PR, AT91C_DDRC2_TRAS_6       |     //  6 * 7.5 = 45   ns
+                                         AT91C_DDRC2_TRCD_2       |     //  2 * 7.5 = 15 ns
+                                         AT91C_DDRC2_TWR_2        |     //  2 * 7.5 = 15   ns
+                                         AT91C_DDRC2_TRC_8       |      //  8 * 7.5 = 60   ns
+                                         AT91C_DDRC2_TRP_2        |     //  2 * 7.5 = 15 ns
+                                         AT91C_DDRC2_TRRD_2       |     //  1 * 7.5 = 7.5   ns
+                                         AT91C_DDRC2_TWTR_1       |     //  1 clock cycle
+                                         AT91C_DDRC2_TMRD_2);           //  2 clock cycles
+          
+          
+            WRITE(pDdrc, HDDRSDRC2_T1PR, AT91C_DDRC2_TXP_2  |           //  2 * 7.5 = 15 ns
+                                         200 << 16          |           // 200 clock cycles, TXSRD: Exit self refresh delay to Read command
+                                         16 << 8            |           // 16 * 7.5 = 120 ns TXSNR: Exit self refresh delay to non read command
+                                         AT91C_DDRC2_TRFC_14 << 0);     // 14 * 7.5 = 105 ns (must be 105 ns for 512M DDR)
+          
+          
+            WRITE(pDdrc, HDDRSDRC2_T2PR, AT91C_DDRC2_TRTP_1   |         //  1 * 7.5 = 7.5 ns
+                                         AT91C_DDRC2_TRPA_0   |         
+                                         AT91C_DDRC2_TXARDS_7 |         //  7 clock cycles
+                                         AT91C_DDRC2_TXARD_2);          //  2 clock cycles
+
+            // Step 3: An NOP command is issued to the DDR2-SDRAM to enable clock.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+            *pDdr = 0;
+ 
+            // Initialization Step 3 (must wait 200 us) (6 core cycles per iteration, core is at 396MHz: min 13200 loops)
+            for (i = 0; i < 13300; i++) {
+                asm("    nop");
+            }
+            // Step 4:  An NOP command is issued to the DDR2-SDRAM 
+            // NOP command -> allow to enable cke
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+            *pDdr = 0;
+            
+            // wait 400 ns min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+
+            // Step 5: An all banks precharge command is issued to the DDR2-SDRAM.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+            *pDdr = 0;
+            
+            // wait 400 ns min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+
+            // Step 6: An Extended Mode Register set (EMRS2) cycle is  issued to chose between commercialor high  temperature operations.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x2000000)) = 0; // BA[1] is set to 1 and BA[0] are set to 0.
+         
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 7: An Extended Mode Register set (EMRS3) cycle is issued to set all registers to 0.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x3000000)) = 0; //BA[1] is set to 1 and BA[0] are set to 1.
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+             
+            // Step 8:  An Extended Mode Register set (EMRS1) cycle is issued to enable DLL.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr)) = 0; //BA[1] and BA[0] are set to 0.
+
+            // wait 200 cycles min
+            for (i = 0; i < 10000; i++) {
+                asm("    nop");
+            }
+            
+            // Step 9:  Program DLL field into the Configuration Register.
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr | AT91C_DDRC2_DLL_RESET_ENABLED);
+            
+            // Step 10: A Mode Register set (MRS) cycle is issued to reset DLL.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_LMR_CMD);
+            *(pDdr) = 0;
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 11: An all banks precharge command is issued to the DDR2-SDRAM.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+            *(pDdr) = 0;
+
+            // wait 400 ns min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+
+            // Step 12: Two auto-refresh (CBR) cycles are provided. Program the auto refresh command (CBR) into the Mode Register.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+            *(pDdr) = 0;
+
+            // wait 10 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            // Set 2nd CBR
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+            *(pDdr) = 0;
+
+            // wait 10 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 13: Program DLL field into the Configuration Register to low(Disable DLL reset).
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_DLL_RESET_ENABLED));
+            
+            // Step 14: A Mode Register set (MRS) cycle is issued to program the parameters of the DDR2-SDRAM devices.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_LMR_CMD);
+            *(pDdr) = 0; //BA[1:0] are set to 0.
+    
+            // Step 15: Program OCD field into the Configuration Register to high (OCD calibration default).
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr | AT91C_DDRC2_OCD_DEFAULT);
+            
+            // Step 16: An Extended Mode Register set (EMRS1) cycle is issued to OCD default value.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x1000000)) = 0; //BA[1] is set to 0 and BA[0] is set to 1
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 17: Program OCD field into the Configuration Register to low (OCD calibration mode exit).
+            cr = READ(pDdrc, HDDRSDRC2_CR);
+            WRITE(pDdrc, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_OCD_EXIT));
+         
+            // Step 18: An Extended Mode Register set (EMRS1) cycle is issued to enable OCD exit.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+            *((unsigned int *)((unsigned char *)pDdr + 0x3000000)) = 0; //BA[1] is set to 1and BA[0] is set to 1.
+
+            // wait 2 cycles min
+            for (i = 0; i < 100; i++) {
+                asm("    nop");
+            }
+            
+            // Step 19,20: A mode Normal command is provided. Program the Normal mode into Mode Register.
+            WRITE(pDdrc, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NORMAL_CMD);
+            *(pDdr) = 0;
+
+            // Step 21: Write the refresh rate into the count field in the Refresh Timer register. The DDR2-SDRAM device requires a
+            // refresh every 15.625 s or 7.81 s. With a 100MHz frequency, the refresh timer count register must to be set with
+            // (15.625 /100 MHz) = 1562 i.e. 0x061A or (7.81 /100MHz) = 781 i.e. 0x030d.
+      
+            // Set Refresh timer
+            WRITE(pDdrc, HDDRSDRC2_RTR, 0x00000411);
+
+            // OK now we are ready to work on the DDRSDR
+
+            // wait for end of calibration
+            for (i = 0; i < 500; i++) {
+                asm("    nop");
+            }
+
+            break;
+
+
+        default:
+            break;
+    }
+}
+
+
+
+//------------------------------------------------------------------------------
+/// Initialize and configure the SDRAM
+//------------------------------------------------------------------------------
+void BOARD_ConfigureSdram(unsigned char busWidth)
+{
+
+    // TO BE IMPLEMENTED IN CASE SDRAM IS MOUNTED.
+
+}
+
+//------------------------------------------------------------------------------
+/// Configures the EBI for NandFlash access. Pins must be configured after or
+/// before calling this function.
+//------------------------------------------------------------------------------
+void BOARD_ConfigureNandFlash(unsigned char busWidth)
+{
+}
+
+//------------------------------------------------------------------------------
+/// Configures the EBI for NandFlash access at 48MHz. Pins must be configured
+/// after or before calling this function.
+//------------------------------------------------------------------------------
+void BOARD_ConfigureNandFlash48MHz(unsigned char busWidth)
+{
+}
+
+//------------------------------------------------------------------------------
+/// Configures the EBI for NorFlash access
+/// \Param busWidth Bus width 
+//------------------------------------------------------------------------------
+void BOARD_ConfigureNorFlash(unsigned char busWidth)
+{
+}
+
+//------------------------------------------------------------------------------
+/// Configures the EBI for NorFlash access at 48MHz.
+/// \Param busWidth Bus width 
+//------------------------------------------------------------------------------
+void BOARD_ConfigureNorFlash48MHz(unsigned char busWidth)
+{
+}
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_memories.h b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_memories.h
new file mode 100644
index 0000000000000000000000000000000000000000..61e5627c0de3c9d6ca30646f16ec510ca8362571
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_memories.h
@@ -0,0 +1,69 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+#ifndef BOARD_MEMORIES_H
+#define BOARD_MEMORIES_H
+
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+// DDRAM models used as parameter of configureDdram().
+#define DDR_MICRON_MT47H64M8           0
+#define DDR_SAMSUNG_M470T6554EZ3_CE6   1
+
+#define VDDMEMSEL_1V8 0
+#define VDDMEMSEL_3V3 1
+
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+extern void BOARD_RemapRom(void);
+
+extern void BOARD_RemapRam(void);
+
+extern void BOARD_ConfigureVddMemSel(unsigned char VddMemSel);
+
+extern void BOARD_ConfigureDdram(unsigned char ddrModel, unsigned char busWidth);
+
+extern void BOARD_ConfigureDdramCp1(unsigned char busWidth);
+
+extern void BOARD_ConfigureSdram(unsigned char busWidth);
+
+extern void BOARD_ConfigureNandFlash(unsigned char busWidth);
+
+extern void BOARD_ConfigureNandFlash48MHz(unsigned char busWidth);
+
+extern void BOARD_ConfigureNorFlash(unsigned char busWidth);
+
+extern void BOARD_ConfigureNorFlash48MHz(unsigned char busWidth);
+
+#endif //#ifndef BOARD_MEMORIES_H
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_powermode.c b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_powermode.c
new file mode 100644
index 0000000000000000000000000000000000000000..cf96605ca883ad5a8419fe5cf0d51918b5ada4f5
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_powermode.c
@@ -0,0 +1,64 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "board.h"
+#include <pmc/pmc.h>
+
+//------------------------------------------------------------------------------
+//         Internal definitions
+//------------------------------------------------------------------------------
+
+
+//------------------------------------------------------------------------------
+//         Internal functions
+//------------------------------------------------------------------------------
+
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Put the CPU in IDLE mode with CP15
+//------------------------------------------------------------------------------
+void LowPowerMode(void)
+{
+    PMC_CPUInIdleMode();
+}
+
+//------------------------------------------------------------------------------
+/// Returns to normal mode automatically
+//------------------------------------------------------------------------------
+void NormalPowerMode(void)
+{
+}
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_powermode.h b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_powermode.h
new file mode 100644
index 0000000000000000000000000000000000000000..47b2738f3fd84489e5a59c7ada6c1125bba4f5ee
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/board_powermode.h
@@ -0,0 +1,50 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+/// !Purpose
+/// 
+///
+/// !Usage
+/// 
+//------------------------------------------------------------------------------
+
+#ifndef BOARD_POWERMODE_H
+#define BOARD_POWERMODE_H
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+extern void LowPowerMode(void);
+
+extern void NormalPowerMode(void);
+
+#endif //#ifndef BOARD_MEMORIES_H
+
diff --git a/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/ddramc.c b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/ddramc.c
new file mode 100644
index 0000000000000000000000000000000000000000..d9bf7f25ad22ef1ce064488c4c9fba3088829f07
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/at91sam9g45-ek/ddramc.c
@@ -0,0 +1,227 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support  -  ROUSSET  -
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2007, Stelian Pop <stelian.pop@leadtechdesign.com>
+ * Copyright (c) 2007 Lead Tech Design <www.leadtechdesign.com>
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaiimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ * File Name           : sdramc.c
+ * Object              :
+ * Creation            :
+ *-----------------------------------------------------------------------------
+ */
+#include "../include/part.h"
+#include "../include/main.h"
+#include "../include/ddramc.h"
+
+#ifdef CFG_DDRAM
+
+/* Write DDRC register */
+static void write_ddramc(unsigned int address, unsigned int offset, const unsigned int value)
+{
+	writel(value, (address + offset));
+}
+
+/* Read DDRC registers */
+static unsigned int read_ddramc(unsigned int address, unsigned int offset)
+{
+	return readl((address + offset));
+}
+
+//*----------------------------------------------------------------------------
+//* \fn    sdram_init
+//* \brief Initialize the SDDRC Controller
+//*----------------------------------------------------------------------------
+int ddram_init(unsigned int ddram_controller_address, unsigned int ddram_address, struct SDdramConfig *ddram_config)
+{
+	volatile unsigned int i;
+	unsigned int cr = 0;
+	
+	// Step 1: Program the memory device type
+	// Configure the DDR controller
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MDR, ddram_config->ddramc_mdr);
+
+	// Program the DDR Controller
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, ddram_config->ddramc_cr); 
+
+	// assume timings for 7.5ns min clock period
+	write_ddramc(ddram_controller_address, HDDRSDRC2_T0PR, ddram_config->ddramc_t0pr);
+
+	// pSDDRC->HDDRSDRC2_T1PR 
+	write_ddramc(ddram_controller_address, HDDRSDRC2_T1PR, ddram_config->ddramc_t1pr);
+
+	// pSDDRC->HDDRSDRC2_T2PR 
+	write_ddramc(ddram_controller_address, HDDRSDRC2_T2PR, ddram_config->ddramc_t2pr);
+
+	// Initialization Step 3: NOP command -> allow to enable clk
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+	*((unsigned volatile int*) ddram_address) = 0;
+ 
+	// Initialization Step 3 (must wait 200 us) (6 core cycles per iteration, core is at 396MHz: min 13200 loops)
+	for (i = 0; i < 13300; i++) {
+		asm("    nop");
+	}
+	
+	// Step 4:  An NOP command is issued to the DDR2-SDRAM 
+	// NOP command -> allow to enable cke
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+	*((unsigned volatile int*) ddram_address) = 0;
+
+	// wait 400 ns min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 5: Set All Bank Precharge
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+	*((unsigned volatile int*) ddram_address) = 0;
+
+	// wait 400 ns min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+       // Initialization Step 6: Set EMR operation (EMRS2)
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*((unsigned int *)(ddram_address + 0x4000000)) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 7: Set EMR operation (EMRS3)
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*((unsigned int *)(ddram_address + 0x6000000)) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 8: Set EMR operation (EMRS1)
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*((unsigned int *)(ddram_address + 0x2000000)) = 0;
+
+	// wait 200 cycles min
+	for (i = 0; i < 10000; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 9: enable DLL reset
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr | AT91C_DDRC2_DLL_RESET_ENABLED);
+
+	// Initialization Step 10: reset DLL
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 11: Set All Bank Precharge
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 400 ns min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 12: Two auto-refresh (CBR) cycles are provided. Program the auto refresh command (CBR) into the Mode Register.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 10 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Set 2nd CBR
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 10 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 13: Program DLL field into the Configuration Register to low(Disable DLL reset).
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_DLL_RESET_ENABLED));
+
+	// Initialization Step 14: A Mode Register set (MRS) cycle is issued to program the parameters of the DDR2-SDRAM devices.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_LMR_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// Step 15: Program OCD field into the Configuration Register to high (OCD calibration default).
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr | AT91C_DDRC2_OCD_DEFAULT);
+
+	// Step 16: An Extended Mode Register set (EMRS1) cycle is issued to OCD default value.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*(((unsigned int*) (ddram_address + 0x2000000))) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Step 17: Program OCD field into the Configuration Register to low (OCD calibration mode exit).
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_OCD_EXIT));
+
+	// Step 18: An Extended Mode Register set (EMRS1) cycle is issued to enable OCD exit.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*(((unsigned int*) (ddram_address + 0x6000000))) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Step 19,20: A mode Normal command is provided. Program the Normal mode into Mode Register.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NORMAL_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// Step 21: Write the refresh rate into the count field in the Refresh Timer register. The DDR2-SDRAM device requires a
+	// refresh every 15.625 ¦Is or 7.81 ¦Ìs. With a 100MHz frequency, the refresh timer count register must to be set with
+	// (15.625 /100 MHz) = 1562 i.e. 0x061A or (7.81 /100MHz) = 781 i.e. 0x030d.
+
+	// Set Refresh timer
+	write_ddramc(ddram_controller_address, HDDRSDRC2_RTR, ddram_config->ddramc_rtr);
+
+	// OK now we are ready to work on the DDRSDR
+
+	// wait for end of calibration
+	for (i = 0; i < 500; i++) {
+		asm("    nop");
+	}
+	
+	return 0;
+}
+
+#endif /* CFG_DDRAM */
diff --git a/usb-loader/samba_applets/at91lib/boards/boards.dir b/usb-loader/samba_applets/at91lib/boards/boards.dir
new file mode 100644
index 0000000000000000000000000000000000000000..f4275d6354417d9cd4def401d0b0b103ed8190cf
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/boards/boards.dir
@@ -0,0 +1,52 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+/// !!!Purpose
+/// 
+/// This directory contains one module for each supported Atmel evaluation kit.
+///
+/// Each module provides the necessary definitions and methods for using the
+/// board in a portable way. This means that there should be NO overhead when
+/// porting a project from a SAM7S to a SAM7SE (for example), given that they
+/// both fullfil the technical requirements of the project.
+///
+/// !!!Contents
+/// Each board subdirectory contains board- and chip-dependant files to provide
+/// a number of services:
+///    - PIO definitions
+///    - Memory initializations
+///    - Startup and low level initialization
+///    - etc.
+///
+/// Please refer to the documentation of each directory for more in-depth
+/// description of what is available.
+//------------------------------------------------------------------------------
+
diff --git a/usb-loader/samba_applets/at91lib/memories/memories.dir b/usb-loader/samba_applets/at91lib/memories/memories.dir
new file mode 100644
index 0000000000000000000000000000000000000000..1093673550a70e9fb3ea05d28200f12e3d422b2d
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/memories.dir
@@ -0,0 +1,37 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+///
+/// This directory contains different memory access APIs and drivers
+///
+//------------------------------------------------------------------------------
\ No newline at end of file
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at26.c b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26.c
new file mode 100644
index 0000000000000000000000000000000000000000..d7934c923098a9eb3c12bca221662a6e0b56f816
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26.c
@@ -0,0 +1,222 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "at26.h"
+#include <board.h>
+#include <utility/assert.h>
+
+//------------------------------------------------------------------------------
+//         Internal definitions
+//------------------------------------------------------------------------------
+
+/// SPI clock frequency used in Hz.
+#define SPCK            1000000
+
+/// SPI chip select configuration value.
+#define CSR             (AT91C_SPI_NCPHA | \
+                         SPID_CSR_DLYBCT(BOARD_MCK, 100) | \
+                         SPID_CSR_DLYBS(BOARD_MCK, 5) | \
+                         SPID_CSR_SCBR(BOARD_MCK, SPCK))
+
+/// Number of recognized dataflash.
+#define NUMDATAFLASH    (sizeof(at26Devices) / sizeof(At26Desc))
+
+//------------------------------------------------------------------------------
+//         Internal variables
+//------------------------------------------------------------------------------
+
+/// Array of recognized serial firmware dataflash chips.
+static const At26Desc at26Devices[] = {
+    // name, Jedec ID, size, page size, block size, block erase command
+    {"AT25DF041A" , 0x0001441F, 1 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"AT25DF161"  , 0x0002461F, 2 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"AT26DF081A" , 0x0001451F, 1 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"AT26DF0161" , 0x0000461F, 2 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"AT26DF161A" , 0x0001461F, 2 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"AT26DF321 " , 0x0000471F, 8 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    // Manufacturer: ST
+    {"M25P05"     , 0x00102020,       64 * 1024, 256, 32 * 1024, AT26_BLOCK_ERASE_64K},
+    {"M25P10"     , 0x00112020,      128 * 1024, 256, 32 * 1024, AT26_BLOCK_ERASE_64K},
+    {"M25P20"     , 0x00122020,      256 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"M25P40"     , 0x00132020,      512 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"M25P80"     , 0x00142020, 1 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"M25P16"     , 0x00152020, 2 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"M25P32"     , 0x00162020, 4 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"M25P64"     , 0x00172020, 8 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    // Manufacturer: Windbond
+    {"W25X10"     , 0x001130EF,      128 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"W25X20"     , 0x001230EF,      256 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"W25X40"     , 0x001330EF,      512 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"W25X80"     , 0x001430EF, 1 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    // Manufacturer: Macronix
+    {"MX25L512"   , 0x001020C2,       64 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"MX25L3205"  , 0x001620C2, 4 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    {"MX25L6405"  , 0x001720C2, 8 * 1024 * 1024, 256, 64 * 1024, AT26_BLOCK_ERASE_64K},
+    // Other
+    {"SST25VF512" , 0x000048BF,       64 * 1024, 256, 32 * 1024, AT26_BLOCK_ERASE_32K}
+};
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Initializes an AT26 driver instance with the given SPI driver and chip 
+/// select value.
+/// \param pAt26  Pointer to an AT26 driver instance.
+/// \param pSpid  Pointer to an SPI driver instance.
+/// \param cs  Chip select value to communicate with the serial flash.
+//------------------------------------------------------------------------------
+void AT26_Configure(At26 *pAt26, Spid *pSpid, unsigned char cs)
+{
+    SpidCmd *pCommand;
+
+    SANITY_CHECK(pAt26);
+    SANITY_CHECK(pSpid);
+    SANITY_CHECK(cs < 4);
+
+    // Configure the SPI chip select for the serial flash
+    SPID_ConfigureCS(pSpid, cs, CSR);
+
+    // Initialize the AT26 fields
+    pAt26->pSpid = pSpid;
+    pAt26->pDesc = 0;
+
+    // Initialize the command structure
+    pCommand = &(pAt26->command);
+    pCommand->pCmd = (unsigned char *) pAt26->pCmdBuffer;
+    pCommand->callback = 0;
+    pCommand->pArgument = 0;
+    pCommand->spiCs = cs;    
+}
+
+//------------------------------------------------------------------------------
+/// Returns 1 if the serial flash driver is currently busy executing a command;
+/// otherwise returns 0.
+/// \param pAt26  Pointer to an At26 driver instance.
+//------------------------------------------------------------------------------
+unsigned char AT26_IsBusy(At26 *pAt26)
+{
+    return SPID_IsBusy(pAt26->pSpid);
+}
+    
+//------------------------------------------------------------------------------
+/// Sends a command to the serial flash through the SPI. The command is made up
+/// of two parts: the first is used to transmit the command byte and optionally,
+/// address and dummy bytes. The second part is the data to send or receive.
+/// This function does not block: it returns as soon as the transfer has been
+/// started. An optional callback can be invoked to notify the end of transfer.
+/// Return 0 if successful; otherwise, returns AT26_ERROR_BUSY if the AT26
+/// driver is currently executing a command, or AT26_ERROR_SPI if the command
+/// cannot be sent because of a SPI error.
+/// \param pAt26  Pointer to an At26 driver instance.
+/// \param cmd  Command byte.
+/// \param cmdSize  Size of command (command byte + address bytes + dummy bytes).
+/// \param pData Data buffer.
+/// \param dataSize  Number of bytes to send/receive.
+/// \param address  Address to transmit.
+/// \param callback  Optional user-provided callback to invoke at end of transfer.
+/// \param pArgument  Optional argument to the callback function.
+//------------------------------------------------------------------------------
+unsigned char AT26_SendCommand(
+    At26 *pAt26,
+    unsigned char cmd,
+    unsigned char cmdSize,
+    unsigned char *pData,
+    unsigned int dataSize,
+    unsigned int address,
+    SpidCallback callback,
+    void *pArgument)
+
+{
+    SpidCmd *pCommand;
+    
+    SANITY_CHECK(pAt26);
+
+    // Check if the SPI driver is available
+    if (AT26_IsBusy(pAt26)) {
+    
+        return AT26_ERROR_BUSY;
+    }
+    
+    // Store command and address in command buffer
+    pAt26->pCmdBuffer[0] = (cmd & 0x000000FF)
+                           | ((address & 0x0000FF) << 24)
+                           | ((address & 0x00FF00) << 8)
+                           | ((address & 0xFF0000) >> 8);
+
+    // Update the SPI transfer descriptor
+    pCommand = &(pAt26->command);
+     pCommand->cmdSize = cmdSize;
+     pCommand->pData = pData;
+     pCommand->dataSize = dataSize;
+     pCommand->callback = callback;
+     pCommand->pArgument = pArgument;
+    
+     // Start the SPI transfer
+     if (SPID_SendCommand(pAt26->pSpid, pCommand)) {
+
+         return AT26_ERROR_SPI;
+     }
+ 
+     return 0;
+}
+
+//------------------------------------------------------------------------------
+/// Tries to detect a serial firmware flash device given its JEDEC identifier.
+/// The JEDEC id can be retrieved by sending the correct command to the device.
+/// Returns the corresponding AT26 descriptor if found; otherwise returns 0.
+/// \param pAt26  Pointer to an AT26 driver instance.
+/// \param jedecId  JEDEC identifier of device.
+//------------------------------------------------------------------------------
+const At26Desc * AT26_FindDevice(At26 *pAt26, unsigned int jedecId)
+{
+    unsigned int i = 0;
+
+    SANITY_CHECK(pAt26);
+
+    // Search if device is recognized
+    pAt26->pDesc = 0;
+    while ((i < NUMDATAFLASH) && !(pAt26->pDesc)) {
+    
+        if (jedecId == at26Devices[i].jedecId) {
+
+            pAt26->pDesc = &(at26Devices[i]);
+        }
+
+        i++;
+    }
+
+    return pAt26->pDesc;
+}
+
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at26.h b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26.h
new file mode 100644
index 0000000000000000000000000000000000000000..4e3aa6de7a942a38b89bf4e0d0a3a908607baaca
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26.h
@@ -0,0 +1,252 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+/// 
+/// The AT26 serial firmware Dataflash driver is based on top of the 
+/// corresponding Spi driver. A Dataflash structure instance has to be 
+/// initialized using the DF_Init function. Then basic dataflash 
+/// operations can be launched using macros such as DF_continuous_read. 
+/// These macros invoke the DF_Command() function which invokes the 
+/// DPI low driver using the SPI_SendCommand() function.
+/// Beware to compute the dataflash internal address, the dataflash sector
+/// description must be known (DataflashDesc). Dataflash can be automatically
+/// detected using the DF_Scan() function.
+///
+/// !Usage
+/// 
+/// -# Initializes an AT26 instance and configures SPI chip select pin
+///    using AT26_Configure().
+/// -# Detect DF and returns DF description corresponding to the device
+///    connected using AT26_FindDevice().This function shall be called by 
+///    the application before AT26_SendCommand().
+/// -# Sends a command to the DF through the SPI using AT26_SendCommand().
+///    The command is identified by its command code and the number of 
+///    bytes to transfer.
+///    -# Example code for sending command to write a page to DF.
+/// \code
+///    // Program page
+///    error = AT26_SendCommand(pAt26, AT26_BYTE_PAGE_PROGRAM, 4,
+///            pData, writeSize, address, 0, 0);
+/// \endcode
+///    -# Example code for sending command to read a page from DF.
+///       If data needs to be received, then a data buffer must be 
+///       provided.
+/// \code
+///    // Start a read operation
+///    error = AT26_SendCommand(pAt26, AT26_READ_ARRAY_LF, 
+///            4, pData, size, address, 0, 0);
+/// \endcode
+///    -# This function does not block; its optional callback will 
+///       be invoked when the transfer completes.
+/// -# Check the AT26 driver is ready or not by polling AT26_IsBusy().
+///
+//------------------------------------------------------------------------------
+#ifndef AT26_H
+#define AT26_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "spid.h"
+
+//------------------------------------------------------------------------------
+//         Macros
+//------------------------------------------------------------------------------
+
+#define AT26_Size(pAt26)            ((pAt26)->pDesc->size)
+#define AT26_PageSize(pAt26)        ((pAt26)->pDesc->pageSize)
+#define AT26_BlockSize(pAt26)       ((pAt26)->pDesc->blockSize)
+#define AT26_Name(pAt26)            ((pAt26)->pDesc->name)
+#define AT26_PageNumber(pAt26)      (AT26_Size(pAt26) / AT26_PageSize(pAt26))
+#define AT26_BlockNumber(pAt26)     (AT26_Size(pAt26) / AT26_BlockSize(pAt26))
+#define AT26_PagePerBlock(pAt26)    (AT26_BlockSize(pAt26) / AT26_PageSize(pAt26))
+#define AT26_BlockEraseCmd(pAt26)   ((pAt26)->pDesc->blockEraseCmd)
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+/// Device is protected, operation cannot be carried out.
+#define AT26_ERROR_PROTECTED        1
+/// Device is busy executing a command.
+#define AT26_ERROR_BUSY             2
+/// There was a problem while trying to program page data.
+#define AT26_ERROR_PROGRAM          3
+/// There was an SPI communication error.
+#define AT26_ERROR_SPI              4
+
+/// Device ready/busy status bit.
+#define AT26_STATUS_RDYBSY          (1 << 0)
+/// Device is ready.
+#define AT26_STATUS_RDYBSY_READY    (0 << 0)
+/// Device is busy with internal operations.
+#define AT26_STATUS_RDYBSY_BUSY     (1 << 0)
+/// Write enable latch status bit.
+#define AT26_STATUS_WEL             (1 << 1)
+/// Device is not write enabled.
+#define AT26_STATUS_WEL_DISABLED    (0 << 1)
+/// Device is write enabled.
+#define AT26_STATUS_WEL_ENABLED     (1 << 1)
+/// Software protection status bitfield.
+#define AT26_STATUS_SWP             (3 << 2)
+/// All sectors are software protected.
+#define AT26_STATUS_SWP_PROTALL     (3 << 2)
+/// Some sectors are software protected.
+#define AT26_STATUS_SWP_PROTSOME    (1 << 2)
+/// No sector is software protected.
+#define AT26_STATUS_SWP_PROTNONE    (0 << 2)
+/// Write protect pin status bit.
+#define AT26_STATUS_WPP             (1 << 4)
+/// Write protect signal is not asserted.
+#define AT26_STATUS_WPP_NOTASSERTED (0 << 4)
+/// Write protect signal is asserted.
+#define AT26_STATUS_WPP_ASSERTED    (1 << 4)
+/// Erase/program error bit.
+#define AT26_STATUS_EPE             (1 << 5)
+/// Erase or program operation was successful.
+#define AT26_STATUS_EPE_SUCCESS     (0 << 5)
+/// Erase or program error detected.
+#define AT26_STATUS_EPE_ERROR       (1 << 5)
+/// Sector protection registers locked bit.
+#define AT26_STATUS_SPRL            (1 << 7)
+/// Sector protection registers are unlocked.
+#define AT26_STATUS_SPRL_UNLOCKED   (0 << 7)
+/// Sector protection registers are locked.
+#define AT26_STATUS_SPRL_LOCKED     (1 << 7)
+
+/// Read array command code.
+#define AT26_READ_ARRAY             0x0B
+/// Read array (low frequency) command code.
+#define AT26_READ_ARRAY_LF          0x03
+/// Block erase command code (4K block).
+#define AT26_BLOCK_ERASE_4K         0x20
+/// Block erase command code (32K block).
+#define AT26_BLOCK_ERASE_32K        0x52
+/// Block erase command code (64K block).
+#define AT26_BLOCK_ERASE_64K        0xD8
+/// Chip erase command code 1.
+#define AT26_CHIP_ERASE_1           0x60
+/// Chip erase command code 2.
+#define AT26_CHIP_ERASE_2           0xC7
+/// Byte/page program command code.
+#define AT26_BYTE_PAGE_PROGRAM      0x02
+/// Sequential program mode command code 1.
+#define AT26_SEQUENTIAL_PROGRAM_1   0xAD
+/// Sequential program mode command code 2.
+#define AT26_SEQUENTIAL_PROGRAM_2   0xAF
+/// Write enable command code.
+#define AT26_WRITE_ENABLE           0x06
+/// Write disable command code.
+#define AT26_WRITE_DISABLE          0x04
+/// Protect sector command code.
+#define AT26_PROTECT_SECTOR         0x36
+/// Unprotect sector command code.
+#define AT26_UNPROTECT_SECTOR       0x39
+/// Read sector protection registers command code.
+#define AT26_READ_SECTOR_PROT       0x3C
+/// Read status register command code.
+#define AT26_READ_STATUS            0x05
+/// Write status register command code.
+#define AT26_WRITE_STATUS           0x01
+/// Read manufacturer and device ID command code.
+#define AT26_READ_JEDEC_ID          0x9F
+/// Deep power-down command code.
+#define AT26_DEEP_PDOWN             0xB9
+/// Resume from deep power-down command code.
+#define AT26_RES_DEEP_PDOWN         0xAB
+
+//------------------------------------------------------------------------------
+//         Types
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Describes a serial firmware flash device parameters.
+//------------------------------------------------------------------------------
+typedef struct _At26Desc {
+
+    /// Device string name.
+    const char *name;
+    /// JEDEC ID of device.
+    unsigned int jedecId;
+    /// Size of device in bytes.
+	unsigned int size;
+    /// Size of one page in bytes.
+	unsigned int pageSize;
+    /// Block erase size in bytes.
+	unsigned int blockSize;
+    /// Block erase command.
+    unsigned int blockEraseCmd;
+
+} At26Desc;
+
+//------------------------------------------------------------------------------
+/// Serial flash driver structure. Holds the current state of the driver, 
+/// including the current command and the descriptor for the underlying device.
+//------------------------------------------------------------------------------
+typedef struct _At26 {
+
+    /// Pointer to the underlying SPI driver.
+	Spid *pSpid;
+    /// Current SPI command sent to the SPI driver.
+	SpidCmd command;
+    /// Pointer to a descriptor for the serial firmware flash device.
+	const At26Desc *pDesc;
+    /// Command buffer.
+	unsigned int pCmdBuffer[2];
+
+} At26;
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+extern void AT26_Configure(At26 *pAt26, Spid *pSpid, unsigned char cs);
+
+extern unsigned char AT26_SendCommand(
+	At26 *pAt26,
+	unsigned char cmd,
+	unsigned char cmdSize,
+	unsigned char *pData,
+	unsigned int dataSize,
+	unsigned int address,
+    SpidCallback callback,
+	void *pArgument);
+
+extern unsigned char AT26_IsBusy(At26 *pAt26);
+
+extern const At26Desc * AT26_FindDevice(
+    At26 *pAt26,
+    unsigned int jedecId);
+
+#endif //#ifndef AT26_H
+
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at26d.c b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26d.c
new file mode 100644
index 0000000000000000000000000000000000000000..0e975944401871b690fae883a26f7d4cd4276cb3
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26d.c
@@ -0,0 +1,355 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "at26.h"
+#include "at26d.h"
+#include "board.h"
+#include <utility/math.h>
+#include <utility/assert.h>
+
+/*****/
+#include <utility/trace.h>
+/*****/
+
+//------------------------------------------------------------------------------
+//         Local functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Wait for transfer to finish calling the SPI driver ISR. (interrupts are disabled)
+/// \param pAt26  Pointer to an AT26 driver instance.
+//------------------------------------------------------------------------------
+static void AT26D_Wait(At26 *pAt26)
+{
+    // Wait for transfer to finish
+    while (AT26_IsBusy(pAt26))
+        SPID_Handler(pAt26->pSpid);
+}
+
+//------------------------------------------------------------------------------
+/// Reads and returns the status register of the serial flash.
+/// \param pAt26  Pointer to an AT26 driver instance.
+//------------------------------------------------------------------------------
+static unsigned char AT26D_ReadStatus(At26 *pAt26)
+{
+    unsigned char error, status;
+
+    SANITY_CHECK(pAt26);
+
+    // Issue a status read command
+    error = AT26_SendCommand(pAt26, AT26_READ_STATUS, 1, &status, 1, 0, 0, 0);
+    ASSERT(!error, "-F- AT26_GetStatus: Failed to issue command.\n\r");
+
+    // Wait for transfer to finish
+    AT26D_Wait(pAt26);
+
+    return status;
+}
+
+//------------------------------------------------------------------------------
+/// Writes the given value in the status register of the serial flash device.
+/// \param pAt26  Pointer to an AT26 driver instance.
+/// \param status  Status to write.
+//------------------------------------------------------------------------------
+static void AT26D_WriteStatus(At26 *pAt26, unsigned char status)
+{
+    unsigned char error;
+
+    SANITY_CHECK(pAt26);
+
+    // Issue a write status command
+    error = AT26_SendCommand(pAt26, AT26_WRITE_STATUS, 1, &status, 1, 0, 0, 0);
+    ASSERT(!error, "-F- AT26_WriteStatus: Failed to issue command.\n\r");
+    // Wait for transfer to finish
+    AT26D_Wait(pAt26);
+}
+
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Waits for the serial flash device to become ready to accept new commands.
+/// \param pAt26  Pointer to an AT26 driver instance.
+//------------------------------------------------------------------------------
+void AT26D_WaitReady(At26 *pAt26)
+{
+    unsigned char ready = 0;
+
+    SANITY_CHECK(pAt26);
+
+    // Read status register and check busy bit
+    while (!ready) {
+
+        ready = ((AT26D_ReadStatus(pAt26) & AT26_STATUS_RDYBSY) == AT26_STATUS_RDYBSY_READY);
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Reads and returns the serial flash device ID.
+/// \param pAt26  Pointer to an AT26 driver instance.
+//------------------------------------------------------------------------------
+unsigned int AT26D_ReadJedecId(At26 *pAt26)
+{
+    unsigned char error;
+    unsigned int id = 0;
+
+    SANITY_CHECK(pAt26);
+ 
+    // Issue a read ID command
+    error = AT26_SendCommand(pAt26, AT26_READ_JEDEC_ID, 1,
+                             (unsigned char *) &id, 3, 0, 0, 0);
+    ASSERT(!error, "-F- AT26_GetJedecId: Could not issue command.\n\r");
+
+    // Wait for transfer to finish
+    AT26D_Wait(pAt26);
+
+    return id;
+}
+
+//------------------------------------------------------------------------------
+/// Enables critical writes operation on a serial flash device, such as sector
+/// protection, status register, etc.
+/// \para pAt26  Pointer to an AT26 driver instance.
+//------------------------------------------------------------------------------
+void AT26D_EnableWrite(At26 *pAt26)
+{
+    unsigned char error;
+
+    SANITY_CHECK(pAt26);
+
+    // Issue a write enable command
+    error = AT26_SendCommand(pAt26, AT26_WRITE_ENABLE, 1, 0, 0, 0, 0, 0);
+    ASSERT(!error, "-F- AT26_EnableWrite: Could not issue command.\n\r");
+
+    // Wait for transfer to finish
+    AT26D_Wait(pAt26);
+}
+
+//------------------------------------------------------------------------------
+/// Unprotects the contents of the serial flash device.
+/// Returns 0 if the device has been unprotected; otherwise returns
+/// SF_PROTECTED.
+/// \param pAt26  Pointer to an AT26 driver instance.
+//------------------------------------------------------------------------------
+unsigned char AT26D_Unprotect(At26 *pAt26)
+{
+    unsigned char status;
+
+    SANITY_CHECK(pAt26);
+
+    // Get the status register value to check the current protection
+    status = AT26D_ReadStatus(pAt26);
+    if ((status & AT26_STATUS_SWP) == AT26_STATUS_SWP_PROTNONE) {
+
+        // Protection already disabled
+        return 0;
+    }
+    
+    // Check if sector protection registers are locked
+    if ((status & AT26_STATUS_SPRL) == AT26_STATUS_SPRL_LOCKED) {
+
+        // Unprotect sector protection registers by writing the status reg.
+        AT26D_EnableWrite(pAt26);
+        AT26D_WriteStatus(pAt26, 0);
+    }
+    
+    // Perform a global unprotect command
+      AT26D_EnableWrite(pAt26);
+    AT26D_WriteStatus(pAt26, 0);
+    
+    // Check the new status
+    status = AT26D_ReadStatus(pAt26);
+    if ((status & (AT26_STATUS_SPRL | AT26_STATUS_SWP)) != 0) {
+
+        return AT26_ERROR_PROTECTED;
+    }
+    else {
+
+        return 0;
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Erases all the content of the memory chip.
+/// \param pAt26  Pointer to an AT26 driver instance.
+//------------------------------------------------------------------------------
+unsigned char AT26D_EraseChip(At26 *pAt26)
+{
+    unsigned char status;
+    unsigned char error;
+
+    SANITY_CHECK(pAt26);
+
+    // Check that the flash is unprotected
+    status = AT26D_ReadStatus(pAt26);
+    if ((status & AT26_STATUS_SWP) != AT26_STATUS_SWP_PROTNONE) {
+        return AT26_ERROR_PROTECTED;
+    }
+    
+    // Enable critical write operation
+      AT26D_EnableWrite(pAt26);
+    
+    // Erase the chip
+    error = AT26_SendCommand(pAt26, AT26_CHIP_ERASE_2, 1, 0, 0, 0, 0, 0);
+    ASSERT(!error, "-F- AT26_ChipErase: Could not issue command.\n\r");
+    // Wait for transfer to finish
+    AT26D_Wait(pAt26);
+    // Poll the Serial flash status register until the operation is achieved
+    AT26D_WaitReady(pAt26);
+
+    return 0;
+}
+
+//------------------------------------------------------------------------------
+/// Erases the specified 64KB block of the serial firmware dataflash.
+/// Returns 0 if successful; otherwise returns AT26_ERROR_PROTECTED if the
+/// device is protected or AT26_ERROR_BUSY if it is busy executing a command.
+/// \param pAt26  Pointer to an AT26 driver instance.
+/// \param address  Address of the block to erase.
+//------------------------------------------------------------------------------
+unsigned char AT26D_EraseBlock(At26 *pAt26, unsigned int address)
+{
+    unsigned char status;
+    unsigned char error;
+
+    SANITY_CHECK(pAt26);
+ 
+    // Check that the flash is ready and unprotected
+    status = AT26D_ReadStatus(pAt26);
+    if ((status & AT26_STATUS_RDYBSY) != AT26_STATUS_RDYBSY_READY) {
+        TRACE_ERROR("AT26D_EraseBlock : Flash busy\n\r");
+        return AT26_ERROR_BUSY;
+    }
+    else if ((status & AT26_STATUS_SWP) != AT26_STATUS_SWP_PROTNONE) {
+        TRACE_ERROR("AT26D_EraseBlock : Flash protected\n\r");
+        return AT26_ERROR_PROTECTED;
+    }
+
+    // Enable critical write operation
+      AT26D_EnableWrite(pAt26);
+
+    // Start the block erase command
+    error = AT26_SendCommand(pAt26, AT26_BlockEraseCmd(pAt26), 4, 0, 0, address, 0, 0);
+    ASSERT(!error, "-F- AT26_EraseBlock: Could not issue command.\n\r");
+    // Wait for transfer to finish
+    AT26D_Wait(pAt26);
+    // Poll the Serial flash status register until the operation is achieved
+    AT26D_WaitReady(pAt26);
+
+    return 0;
+}
+
+//------------------------------------------------------------------------------
+/// Writes data at the specified address on the serial firmware dataflash. The
+/// page(s) to program must have been erased prior to writing. This function
+/// handles page boundary crossing automatically.
+/// Returns 0 if successful; otherwise, returns AT26_ERROR_PROGRAM is there has
+/// been an error during the data programming.
+/// \param pAt26  Pointer to an AT26 driver instance.
+/// \param pData  Data buffer.
+/// \param size  Number of bytes in buffer.
+/// \param address  Write address.
+//------------------------------------------------------------------------------
+unsigned char AT26D_Write(
+    At26 *pAt26,
+    unsigned char *pData,
+    unsigned int size,
+    unsigned int address)
+{
+    unsigned int pageSize;
+    unsigned int writeSize;
+    unsigned char error;
+    unsigned char status;
+
+    SANITY_CHECK(pAt26);
+    SANITY_CHECK(pData);
+
+    // Retrieve device page size
+    pageSize = AT26_PageSize(pAt26);
+
+    // Program one page after the other
+    while (size > 0) {
+        // Compute number of bytes to program in page
+        writeSize = min(size, pageSize - (address % pageSize));
+
+        // Enable critical write operation
+        AT26D_EnableWrite(pAt26);
+     
+         // Program page
+          error = AT26_SendCommand(pAt26, AT26_BYTE_PAGE_PROGRAM, 4,
+                           pData, writeSize, address, 0, 0);
+        ASSERT(!error, "-F- AT26_WritePage: Failed to issue command.\n\r");
+        // Wait for transfer to finish
+        AT26D_Wait(pAt26);
+        // Poll the Serial flash status register until the operation is achieved
+        AT26D_WaitReady(pAt26);
+
+        // Make sure that write was without error
+        status = AT26D_ReadStatus(pAt26);
+        if ((status & AT26_STATUS_EPE) == AT26_STATUS_EPE_ERROR) {
+
+            return AT26_ERROR_PROGRAM;
+        }
+        pData += writeSize;
+        size -= writeSize;
+        address += writeSize;
+    }
+
+    return 0;
+}
+
+//------------------------------------------------------------------------------
+/// Reads data from the specified address on the serial flash.
+/// \param pAt26  Pointer to an AT26 driver instance.
+/// \param pData  Data buffer.
+/// \param size  Number of bytes to read.
+/// \param address  Read address.
+//------------------------------------------------------------------------------
+unsigned char AT26D_Read(
+    At26 *pAt26,
+    unsigned char *pData,
+    unsigned int size,
+    unsigned int address)
+{
+    unsigned char error;
+    
+     // Start a read operation
+      error = AT26_SendCommand(pAt26, AT26_READ_ARRAY_LF, 4, pData, size, address, 0, 0);
+    ASSERT(!error, "-F- AT26_Read: Could not issue command.\n\r");
+    // Wait for transfer to finish
+    AT26D_Wait(pAt26);
+    
+    return error;
+}
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at26d.h b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26d.h
new file mode 100644
index 0000000000000000000000000000000000000000..9bed20630afc0ebd1049352263b780457e8cd524
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at26d.h
@@ -0,0 +1,79 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+/// !Purpose
+/// 
+/// The AT26 Serialflash driver.
+/// 
+/// !Usage
+//------------------------------------------------------------------------------
+
+#ifndef AT26D_H
+#define AT26D_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "at26.h"
+
+
+//------------------------------------------------------------------------------
+//         Macros
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+extern void AT26D_WaitReady(At26 *pAt26);
+
+extern unsigned int AT26D_ReadJedecId(At26 *pAt26);
+
+extern unsigned char AT26D_Unprotect(At26 *pAt26);
+
+extern unsigned char AT26D_EraseChip(At26 *pAt26);
+
+extern unsigned char AT26D_EraseBlock(At26 *pAt26, unsigned int address);
+
+extern unsigned char AT26D_Write(
+    At26 *pAt26,
+    unsigned char *pData,
+    unsigned int size,
+    unsigned int address);
+    
+extern unsigned char AT26D_Read(
+    At26 *pAt26,
+    unsigned char *pData,
+    unsigned int size,
+    unsigned int address);    
+
+#endif // #ifndef AT26D_H
+
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at45.c b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45.c
new file mode 100644
index 0000000000000000000000000000000000000000..142e7ed3e0a2bfcc7ff74ecf5508995ef512d0a9
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45.c
@@ -0,0 +1,257 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "at45.h"
+#include <board.h>
+#include <utility/assert.h>
+
+#include <string.h>
+
+//------------------------------------------------------------------------------
+//         Internal definitions
+//------------------------------------------------------------------------------
+
+/// Number of dataflash which can be recognized.
+#define NUMDATAFLASH    (sizeof(at45Devices) / sizeof(At45Desc))
+
+//------------------------------------------------------------------------------
+//         Local variables
+//------------------------------------------------------------------------------
+
+/// indicate if the device is configured as binary page or not.
+static unsigned char configuredBinaryPage;
+
+//------------------------------------------------------------------------------
+//         Internal variables
+//------------------------------------------------------------------------------
+
+static const At45Desc at45Devices[] = {
+    {  512,  1, 264,   9, 0x0C, "AT45DB011D"},
+    { 1024,  1, 264,   9, 0x14, "AT45DB021D"},
+    { 2048,  1, 264,   9, 0x1C, "AT45DB041D"},
+    { 4096,  1, 264,   9, 0x24, "AT45DB081D"},
+    { 4096,  1, 528,  10, 0x2C, "AT45DB161D"},
+    { 8192,  1, 528,  10, 0x34, "AT45DB321D"},
+    { 8192,  1, 1056, 11, 0x3C, "AT45DB642D"},
+    {16384,  1, 1056, 11, 0x10, "AT45DB1282"},
+    {16384,  1, 2112, 12, 0x18, "AT45DB2562"},
+    {32768,  1, 2112, 12, 0x20, "AT45DB5122"}
+};
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Initializes an AT45 instance and configures SPI chip select register.
+/// Always returns 0.
+/// \param pAt45  Pointer to the At45 instance to initialize.
+/// \param pSpid  Pointer to the underlying SPI driver.
+/// \param spiCs  Chip select value to connect to the At45.
+//------------------------------------------------------------------------------
+unsigned char AT45_Configure(At45 *pAt45, Spid *pSpid, unsigned char spiCs)
+{
+    SpidCmd *pCommand;
+
+    // Sanity checks
+    ASSERT(pSpid, "AT45_Configure: pSpid is 0.\n\r");
+    ASSERT(pAt45, "AT45_Configure: pAt45 is 0.\n\r");
+
+    // Initialize the At45 instance
+    pAt45->pSpid = pSpid;
+    pAt45->pDesc = 0;
+    memset(pAt45->pCmdBuffer, 0, 8);
+
+    // Initialize the spidCmd structure
+    pCommand = &(pAt45->command);
+    pCommand->pCmd = pAt45->pCmdBuffer;
+    pCommand->callback = 0;
+    pCommand->pArgument = 0;
+    pCommand->spiCs = spiCs;
+
+    return 0;
+}
+
+//------------------------------------------------------------------------------
+/// This function returns 1 if the At45 driver is not executing any command;
+/// otherwise it returns 0.
+/// \param pAt45  Pointer to an At45 instance.
+//------------------------------------------------------------------------------
+unsigned char AT45_IsBusy(At45 *pAt45)
+{
+    return SPID_IsBusy(pAt45->pSpid);
+}
+
+//------------------------------------------------------------------------------
+/// Sends a command to the dataflash through the SPI. The command is identified
+/// by its command code and the number of bytes to transfer (1 + number of
+/// address bytes + number of dummy bytes). If data needs to be received, then
+/// a data buffer must be provided.
+/// This function does not block; its optional callback will be invoked when
+/// the transfer completes.
+/// \param pAt45  Pointer to an At45 driver instance.
+/// \param cmd  Command code.
+/// \param cmdSize  Size of command code + address bytes + dummy bytes.
+/// \param pData  Data buffer.
+/// \param dataSize  Number of data bytes to send/receive.
+/// \param address  Address at which the command is performed if meaningful.
+/// \param callback  Optional callback to invoke at end of transfer.
+/// \param pArgument  Optional parameter to the callback function.
+//------------------------------------------------------------------------------
+unsigned char AT45_SendCommand(
+    At45 *pAt45,
+    unsigned char cmd,
+    unsigned char cmdSize,
+    unsigned char *pData,
+    unsigned int dataSize,
+    unsigned int address,
+    SpidCallback callback,
+    void *pArgument)
+{
+    SpidCmd *pCommand;
+    const At45Desc *pDesc = pAt45->pDesc;
+    unsigned int dfAddress = 0;
+
+    // Sanity checks
+    ASSERT(pAt45, "AT45_Command: pAt45 is 0.\n\r");
+    ASSERT(pDesc || (cmd == AT45_STATUS_READ),
+           "AT45_Command: Device has no descriptor, only STATUS_READ command allowed\n\r");
+
+    // Check if the SPI driver is available
+    if (AT45_IsBusy(pAt45)) {
+
+        return AT45_ERROR_LOCK;
+    }
+
+    // Compute command pattern
+    pAt45->pCmdBuffer[0] = cmd;
+
+    // Add address bytes if necessary
+    if (cmdSize > 1) {
+
+        ASSERT(pDesc, "AT45_Command: No descriptor for dataflash.\n\r");
+        if (!configuredBinaryPage) {
+            dfAddress =
+                ((address / (pDesc->pageSize)) << pDesc->pageOffset)
+                 + (address % (pDesc->pageSize));
+        }
+        else {
+            dfAddress = address;
+        }
+        // Write address bytes
+        if (pDesc->pageNumber >= 16384) {
+
+            pAt45->pCmdBuffer[1] = ((dfAddress & 0x0F000000) >> 24);
+            pAt45->pCmdBuffer[2] = ((dfAddress & 0x00FF0000) >> 16);
+            pAt45->pCmdBuffer[3] = ((dfAddress & 0x0000FF00) >> 8);
+            pAt45->pCmdBuffer[4] = ((dfAddress & 0x000000FF) >> 0);
+    
+            if ((cmd != AT45_CONTINUOUS_READ) && (cmd != AT45_PAGE_READ)) {
+    
+                cmdSize++;
+            }
+        }
+        else {
+
+            pAt45->pCmdBuffer[1] = ((dfAddress & 0x00FF0000) >> 16);
+            pAt45->pCmdBuffer[2] = ((dfAddress & 0x0000FF00) >> 8);
+            pAt45->pCmdBuffer[3] = ((dfAddress & 0x000000FF) >> 0);
+        }
+    }
+
+    // Update the SPI Transfer descriptors
+    pCommand = &(pAt45->command);
+    pCommand->cmdSize = cmdSize;
+    pCommand->pData = pData;
+    pCommand->dataSize = dataSize;
+    pCommand->callback = callback;
+    pCommand->pArgument = pArgument;
+
+    // Send Command and data through the SPI
+    if (SPID_SendCommand(pAt45->pSpid, pCommand)) {
+
+        return AT45_ERROR_SPI;
+    }
+
+    return 0;
+}
+
+//------------------------------------------------------------------------------
+/// This function returns the At45Desc structure corresponding to the device
+/// connected
+/// It automatically initializes pAt45->pDesc field structure.
+/// This function shall be called by the application before AT45_SendCommand.
+/// Returns 0 if successful; Otherwise, returns AT45_ERROR_LOCK if the At45
+/// driver is in use or AT45_ERROR_SPI if there was an error with the SPI driver.
+/// \param pAt45  Pointer to an AT45 driver instance.
+/// \param status  Device status register value.
+//------------------------------------------------------------------------------
+const At45Desc * AT45_FindDevice(At45 *pAt45, unsigned char status)
+{
+    unsigned int i;
+    unsigned char id = AT45_STATUS_ID(status);
+
+    // Check if status is all one; in which case, it is assumed that no device
+    // is connected
+    if (status == 0xFF) {
+
+        return 0;
+    }
+
+    // Look in device array
+    i = 0;
+    pAt45->pDesc = 0;
+    while ((i < NUMDATAFLASH) && !(pAt45->pDesc)) {
+
+        if (at45Devices[i].id == id) {
+
+            pAt45->pDesc = &(at45Devices[i]);
+        }
+        i++;
+    }
+    configuredBinaryPage = AT45_STATUS_BINARY(status);
+    return pAt45->pDesc;
+}
+
+//------------------------------------------------------------------------------
+/// This function returns the pagesize corresponding to the device connected
+/// \param pAt45  Pointer to an AT45 driver instance.
+//------------------------------------------------------------------------------
+unsigned int  AT45_PageSize(At45 *pAt45)
+{
+    unsigned int pagesize = pAt45->pDesc->pageSize;
+    if(((pAt45->pDesc->hasBinaryPage) == 0) || !configuredBinaryPage){
+        return pagesize;
+    }
+    return ((pagesize >> 8) << 8);
+}
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at45.h b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45.h
new file mode 100644
index 0000000000000000000000000000000000000000..ef7ef26ba371052a337ef34b031594bc258052da
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45.h
@@ -0,0 +1,255 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !!!Purpose
+/// 
+/// The Dataflash driver is based on top of the corresponding Spi driver.
+/// A Dataflash structure instance has to be initialized using the DF_Init
+/// function. Then basic dataflash operations can be launched using macros such
+/// as DF_continuous_read. These macros invoke the DF_Command() function which
+/// invokes the DPI low driver using the SPI_SendCommand() function.
+/// Beware to compute the dataflash internal address, the dataflash sector
+/// description must be known (DataflashDesc). Dataflash can be automatically
+/// detected using the DF_Scan() function.
+/// !!!Usage
+/// 
+/// -# Initializes an AT45 instance and configures SPI chip select pin
+///    using AT45_Configure().
+/// -# Detect DF and returns DF description corresponding to the device
+///    connected using AT45_FindDevice().This function shall be called by 
+///    the application before AT45_SendCommand.
+/// -# Sends a command to the DF through the SPI using AT45_SendCommand().
+///    The command is identified by its command code and the number of 
+///    bytes to transfer.
+///    -# Example code for sending command to write a page to DF.
+/// \code
+///    // Issue a page write through buffer 1 command
+///	   error = AT45_SendCommand(pAt45, AT45_PAGE_WRITE_BUF1, 4, 
+///	           pBuffer, size, address, 0, 0);
+/// \endcode
+///    -# Example code for sending command to read a page from DF.
+///       If data needs to be received, then a data buffer must be 
+///       provided.
+/// \code
+///    // Issue a continuous read array command
+///    error = AT45_SendCommand(pAt45, AT45_CONTINUOUS_READ_LEG, 8,
+///            pBuffer, size, address, 0, 0);
+/// \endcode
+///    -# This function does not block; its optional callback will 
+///       be invoked when the transfer completes.
+/// -# Check the AT45 driver is ready or not by polling AT45_IsBusy().
+/// 
+//------------------------------------------------------------------------------
+
+#ifndef AT45_H
+#define AT45_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "spid.h"
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+/// The dataflash driver is currently in use.
+#define AT45_ERROR_LOCK         1
+/// There was an error with the SPI driver.
+#define AT45_ERROR_SPI          2
+
+/// AT45 dataflash SPI CSR settings given MCK and SPCK.
+#define AT45_CSR(mck, spck) \
+    (AT91C_SPI_NCPHA | SPID_CSR_DLYBCT(mck, 250) \
+     | SPID_CSR_DLYBS(mck, 250) | SPID_CSR_SCBR(mck, spck))
+
+//------------------------------------------------------------------------------
+//         Macros
+//------------------------------------------------------------------------------
+
+#define AT45_PageOffset(pAt45) ((pAt45)->pDesc->pageOffset)
+#define AT45_PageNumber(pAt45) ((pAt45)->pDesc->pageNumber)
+
+/// Returns 1 if the device is ready; otherwise 0.
+#define AT45_STATUS_READY(status)       (status & 0x80)
+/// Returns the device ID code.
+#define AT45_STATUS_ID(status)          (status & 0x3c)
+/// Returns 1 if the device is configured in binary page mode; otherwise 0.
+#define AT45_STATUS_BINARY(status)      (status & 0x01)
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+/// Main memory page read command code.
+#define AT45_PAGE_READ              0xD2
+/// Continous array read (legacy) command code.
+#define AT45_CONTINUOUS_READ_LEG    0xE8
+/// Continous array read (low frequency) command code.
+#define AT45_CONTINUOUS_READ_LF     0x03
+/// Continous array read command code.
+#define AT45_CONTINUOUS_READ        0x0B
+/// Buffer 1 read (low frequency) command code.
+#define AT45_BUF1_READ_LF           0xD1
+/// Buffer 2 read (low frequency) command code.
+#define AT45_BUF2_READ_LF           0xD3
+/// Buffer 1 read (serial) command code.
+#define AT45_BUF1_READ_SER          0xD4
+/// Buffer 2 read (serial) command code.
+#define AT45_BUF2_READ_SER          0xD6
+/// Buffer 1 read (8-bit) command code.
+#define AT45_BUF1_READ_8B           0x54
+/// Buffer 2 read (8-bit) command code.
+#define AT45_BUF2_READ_8B           0x56
+
+/// Buffer 1 write command code.
+#define AT45_BUF1_WRITE             0x84
+/// Buffer 2 write command code.
+#define AT45_BUF2_WRITE             0x87
+/// Buffer 1 to main memory page program with erase command code.
+#define AT45_BUF1_MEM_ERASE         0x83
+/// Buffer 2 to main memory page program with erase command code.
+#define AT45_BUF2_MEM_ERASE         0x86
+/// Buffer 1 to main memory page program without erase command code.
+#define AT45_BUF1_MEM_NOERASE       0x88
+/// Buffer 2 to main memory page program without erase command code.
+#define AT45_BUF2_MEM_NOERASE       0x89
+/// Page erase command code.
+#define AT45_PAGE_ERASE             0x81
+/// Block erase command code.
+#define AT45_BLOCK_ERASE            0x50
+/// Sector erase command code.
+#define AT45_SECTOR_ERASE           0x7C
+/// Chip erase command code.
+#define AT45_CHIP_ERASE             0xC7, 0x94, 0x80, 0x9A
+/// Main memory page program through buffer 1 command code.
+#define AT45_PAGE_WRITE_BUF1        0x82
+/// Main memory page program through buffer 2 command code.
+#define AT45_PAGE_WRITE_BUF2        0x85
+
+/// Main memory page to buffer 1 transfer command code.
+#define AT45_PAGE_BUF1_TX           0x53
+/// Main memory page to buffer 2 transfer command code.
+#define AT45_PAGE_BUF2_TX           0x55
+/// Main memory page to buffer 1 compare command code.
+#define AT45_PAGE_BUF1_CMP          0x60
+/// Main memory page to buffer 2 compare command code.
+#define AT45_PAGE_BUF2_CMP          0x61
+/// Auto page rewrite through buffer 1 command code.
+#define AT45_AUTO_REWRITE_BUF1      0x58
+/// Auto page rewrite through buffer 2 command code.
+#define AT45_AUTO_REWRITE_BUF2      0x59
+/// Deep power-down command code.
+#define AT45_DEEP_PDOWN             0xB9
+/// Resume from deep power-down command code.
+#define AT45_RES_DEEP_PDOWN         0xAB
+/// Status register read command code.
+#define AT45_STATUS_READ            0xD7
+/// Manufacturer and device ID read command code.
+#define AT45_ID_READ                0x9F
+
+/// Power-of-2 binary page size configuration command code.
+#define AT45_BINARY_PAGE_FIRST_OPCODE   0x3D
+#define AT45_BINARY_PAGE                0x2A, 0x80, 0xA6
+
+//------------------------------------------------------------------------------
+//         Types
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Dataflash description. A constant array of DataflashDesc instance is defined
+/// in at45.c. The DF_Scan() function returns the corresponding descriptor
+/// according to the dataflash ID detected.
+/// This description (page_size, page_offset) is used to compute the internal
+/// dataflash address by the DF_Command() function.
+//------------------------------------------------------------------------------
+typedef struct {
+
+    /// dataflash page number.
+	unsigned int pageNumber;
+    // indicate if power-of-2 binary page supported.
+	unsigned int hasBinaryPage;
+    /// dataflash page size.
+	unsigned int pageSize;
+    /// page offset in command.
+	unsigned int pageOffset;
+    /// Dataflash ID.
+	unsigned char id;
+    /// Identifier.
+	const char *name;
+
+} At45Desc;
+
+//------------------------------------------------------------------------------
+/// Dataflash driver structure. It holds the current command being processed.
+/// This structure is initialized by the DF_Init() command.
+/// pDfDesc field can be initialized by the DF_Scan() function.
+/// cmdBuffer is a private driver area used to compute the dataflash address to
+/// be sent to the dataflash. 
+/// Beware the PDC master must have access to this area.
+//------------------------------------------------------------------------------
+typedef struct _Dataflash {
+
+    /// Pointer to Spi Structure (SPI low level driver).
+	Spid *pSpid;
+    /// Current SPI command sent to the SPI low level driver.
+	SpidCmd command;
+    /// Pointer to the dataflash description.
+	const At45Desc *pDesc;
+    /// Buffer to store the current command (opcode + dataflash address.
+	unsigned char pCmdBuffer[8];
+
+} At45;
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+extern unsigned char AT45_Configure(At45 *pAt45, Spid *pSpid, unsigned char spiCs);
+
+extern unsigned char AT45_IsBusy(At45 *pAt45);
+
+extern unsigned char AT45_SendCommand(
+	At45 *pAt45,
+	unsigned char cmd,
+	unsigned char cmdSize,
+	unsigned char *pData,
+	unsigned int dataSize,
+	unsigned int address,
+	SpidCallback callback,
+	void *pArgument);
+
+extern const At45Desc * AT45_FindDevice(At45 *pAt45, unsigned char status);
+
+extern unsigned int  AT45_PageSize(At45 *pAt45);
+#endif // #ifndef AT45_H
+
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at45d.c b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45d.c
new file mode 100644
index 0000000000000000000000000000000000000000..f7eab1491741045ca164ebacd78a0d4560e55d46
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45d.c
@@ -0,0 +1,225 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "at45.h"
+#include "at45d.h"
+#include <board.h>
+#include <utility/assert.h>
+
+//------------------------------------------------------------------------------
+//         Local functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Wait for transfer to finish calling the SPI driver ISR (interrupts are
+/// disabled).
+/// \param pAt45  Pointer to an AT45 driver instance.
+//------------------------------------------------------------------------------
+static void AT45D_Wait(At45 *pAt45)
+{
+    SANITY_CHECK(pAt45);
+
+    // Wait for transfer to finish
+    while (AT45_IsBusy(pAt45)) {
+    
+        SPID_Handler(pAt45->pSpid);
+    }
+}
+
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Waits for the At45 to be ready to accept new commands.
+/// \param pAt45  Pointer to a At45 driver instance.
+//------------------------------------------------------------------------------
+void AT45D_WaitReady(At45 *pAt45) 
+{
+    volatile unsigned char ready = 0;
+
volatile int i;
+    SANITY_CHECK(pAt45);
+
+    // Poll device until it is ready
+    while (!ready) {
+
+        ready = AT45_STATUS_READY(AT45D_GetStatus(pAt45));
+		for(i=0;i<20000;i++);
+//        printf("GetStatus!\m");
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Retrieves and returns the At45 current status, or 0 if an error
+/// happened.
+/// \param pAt45  Pointer to a At45 driver instance.
+//------------------------------------------------------------------------------
+unsigned char AT45D_GetStatus(At45 *pAt45)
+{
+    unsigned char error;
+    unsigned char status;
+
+    SANITY_CHECK(pAt45);
+
+    // Issue a status register read command
+    error = AT45_SendCommand(pAt45, AT45_STATUS_READ, 1, &status, 1, 0, 0, 0);
+    ASSERT(!error, "-F- AT45_GetStatus: Failed to issue command.\n\r");
+
+    // Wait for command to terminate
+    while (AT45_IsBusy(pAt45)) {
+    
+        AT45D_Wait(pAt45);
+    }
+
+    return status;
+}
+
+//------------------------------------------------------------------------------
+/// Reads data from the At45 inside the provided buffer. Since a continuous
+/// read command is used, there is no restriction on the buffer size and read
+/// address.
+/// \param pAt45  Pointer to a At45 driver instance.
+/// \param pBuffer  Data buffer.
+/// \param size  Number of bytes to read.
+/// \param address  Address at which data shall be read.
+//------------------------------------------------------------------------------
+void AT45D_Read(
+    At45 *pAt45,
+    unsigned char *pBuffer,
+    unsigned int size,
+    unsigned int address) 
+{
+    unsigned char error;
+
+    SANITY_CHECK(pAt45);
+    SANITY_CHECK(pBuffer);
+
+    // Issue a continuous read array command
+    error = AT45_SendCommand(pAt45, AT45_CONTINUOUS_READ_LEG, 8, pBuffer, size, address, 0, 0);
+    ASSERT(!error, "-F- AT45_Read: Failed to issue command\n\r");
+
+    // Wait for the read command to execute
+    while (AT45_IsBusy(pAt45)) {
+    
+        AT45D_Wait(pAt45);
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Writes data on the At45 at the specified address. Only one page of
+/// data is written that way; if the address is not at the beginning of the
+/// page, the data is written starting from this address and wraps around to
+/// the beginning of the page.
+/// \param pAt45  Pointer to a At45 driver instance.
+/// \param pBuffer  Buffer containing the data to write.
+/// \param size  Number of bytes to write.
+/// \param address  Destination address on the At45.
+//------------------------------------------------------------------------------
+void AT45D_Write(
+    At45 *pAt45,
+    unsigned char *pBuffer,
+    unsigned int size,
+    unsigned int address) 
+{
+    unsigned char error;
+
+    SANITY_CHECK(pAt45);
+    SANITY_CHECK(pBuffer);
+    SANITY_CHECK(size <= pAt45->pDesc->pageSize);
+
+    // Issue a page write through buffer 1 command
+    error = AT45_SendCommand(pAt45, AT45_PAGE_WRITE_BUF1, 4, pBuffer, size, address, 0, 0);
+    ASSERT(!error, "-F- AT45_Write: Could not issue command.\n\r");
+
+    // Wait until the command is sent
+    while (AT45_IsBusy(pAt45)) {
+    
+        AT45D_Wait(pAt45);
+    }
+
+    // Wait until the At45 becomes ready again
+    AT45D_WaitReady(pAt45);
+}
+
+//------------------------------------------------------------------------------
+/// Erases a page of data at the given address in the At45.
+/// \param pAt45  Pointer to a At45 driver instance.
+/// \param address  Address of page to erase.
+//------------------------------------------------------------------------------
+void AT45D_Erase(At45 *pAt45, unsigned int address) 
+{
+    unsigned char error;
+
+    SANITY_CHECK(pAt45);
+
+    // Issue a page erase command.
+    error = AT45_SendCommand(pAt45, AT45_PAGE_ERASE, 4, 0, 0, address, 0, 0);
+    ASSERT(!error, "-F- AT45_Erase: Could not issue command.\n\r");
+
+    // Wait for end of transfer
+    while (AT45_IsBusy(pAt45)) {
+    
+        AT45D_Wait(pAt45);
+    }
+
+    // Poll until the At45 has completed the erase operation
+    AT45D_WaitReady(pAt45);
+}
+
+//------------------------------------------------------------------------------
+/// Configure power-of-2 binary page size in the At45.
+/// \param pAt45  Pointer to a At45 driver instance.
+//------------------------------------------------------------------------------
+
+void AT45D_BinaryPage(At45 *pAt45) 
+{
+    unsigned char error;
+    unsigned char opcode[3]= {AT45_BINARY_PAGE};
+    SANITY_CHECK(pAt45);
+
+    // Issue a binary page command.
+
+    error = AT45_SendCommand(pAt45, AT45_BINARY_PAGE_FIRST_OPCODE, 1, opcode, 3, 0, 0, 0);
+   
+    ASSERT(!error, "-F- AT45_Erase: Could not issue command.\n\r");
+
+    // Wait for end of transfer
+    while (AT45_IsBusy(pAt45)) {
+    
+        AT45D_Wait(pAt45);
+    }
+
+    // Wait until the At45 becomes ready again
+    AT45D_WaitReady(pAt45);
+}
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/at45d.h b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45d.h
new file mode 100644
index 0000000000000000000000000000000000000000..b5124459bde9710f12bd04455eba44a744373fbb
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/at45d.h
@@ -0,0 +1,86 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !!!Purpose
+/// 
+/// The AT45 Dataflash driver is based on the corresponding AT45 driver. 
+/// A AT45 instance has to be initialized using the Dataflash levle function
+/// AT45_Configure(). AT45 Dataflash can be automatically detected using 
+/// the AT45_FindDevice() function. Then AT45 dataflash operations such as 
+/// read, write and erase DF can be launched using AT45_SendCommand function
+/// with corresponding AT45 command set.
+/// 
+/// !!!Usage
+/// 
+/// -# Reads data from the At45 at the specified address using AT45D_Read().
+/// -# Writes data on the At45 at the specified address using AT45D_Write().
+/// -# Erases a page of data at the given address using AT45D_Erase().
+/// -# Poll until the At45 has completed of corresponding operations using 
+///    AT45D_WaitReady().
+/// -# Retrieves and returns the At45 current using AT45D_GetStatus().
+//------------------------------------------------------------------------------
+
+
+#ifndef AT45D_H
+#define AT45D_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "at45.h"
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+extern void AT45D_WaitReady(At45 *pAt45); 
+
+extern unsigned char AT45D_GetStatus(At45 *pAt45);
+
+extern void AT45D_Read(
+    At45 *pAt45,
+    unsigned char *pBuffer,
+    unsigned int size,
+    unsigned int address); 
+
+extern void AT45D_Write(
+    At45 *pAt45,
+    unsigned char *pBuffer,
+    unsigned int size,
+    unsigned int address); 
+
+extern void AT45D_Erase(At45 *pAt45, unsigned int address);
+
+extern void AT45D_BinaryPage(At45 *pAt45);
+
+#endif //#ifndef AT45D_H
+
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/spi-flash.dir b/usb-loader/samba_applets/at91lib/memories/spi-flash/spi-flash.dir
new file mode 100644
index 0000000000000000000000000000000000000000..c2f3c2f143fc692de0db9c79e158ef97abebeca8
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/spi-flash.dir
@@ -0,0 +1,37 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+///
+/// Contains the %spi-flash driver for the SPI compatible Dataflash.
+//------------------------------------------------------------------------------
+
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/spid.c b/usb-loader/samba_applets/at91lib/memories/spi-flash/spid.c
new file mode 100644
index 0000000000000000000000000000000000000000..3dd0409beed1bed88bbf58db13459d235f9e4f41
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/spid.c
@@ -0,0 +1,215 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "spid.h"
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Macros
+//------------------------------------------------------------------------------
+
+/// Write PMC register
+#define WRITE_PMC(pPmc, regName, value) pPmc->regName = (value)
+
+/// Write SPI register
+#define WRITE_SPI(pSpi, regName, value) pSpi->regName = (value)
+
+/// Read SPI registers
+#define READ_SPI(pSpi, regName) (pSpi->regName)
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Initializes the Spid structure and the corresponding SPI hardware.
+/// Always returns 0.
+/// \param pSpid  Pointer to a Spid instance.
+/// \param pSpiHw  Associated SPI peripheral.
+/// \param spiId  SPI peripheral identifier.
+//------------------------------------------------------------------------------
+unsigned char SPID_Configure(Spid *pSpid, AT91S_SPI *pSpiHw, unsigned char spiId)
+{
+    // Initialize the SPI structure
+    pSpid->pSpiHw = pSpiHw;
+    pSpid->spiId  = spiId;
+    pSpid->semaphore = 1;
+    pSpid->pCurrentCommand = 0;
+
+    // Enable the SPI clock
+    WRITE_PMC(AT91C_BASE_PMC, PMC_PCER, (1 << pSpid->spiId));
+    
+    // Execute a software reset of the SPI twice
+    WRITE_SPI(pSpiHw, SPI_CR, AT91C_SPI_SWRST);
+    WRITE_SPI(pSpiHw, SPI_CR, AT91C_SPI_SWRST);
+
+    // Configure SPI in Master Mode with No CS selected !!!
+    WRITE_SPI(pSpiHw, SPI_MR, AT91C_SPI_MSTR | AT91C_SPI_MODFDIS | AT91C_SPI_PCS);
+     
+    // Disable the PDC transfer    
+    WRITE_SPI(pSpiHw, SPI_PTCR, AT91C_PDC_RXTDIS | AT91C_PDC_TXTDIS);
+
+    // Enable the SPI
+    WRITE_SPI(pSpiHw, SPI_CR, AT91C_SPI_SPIEN);
+
+    // Enable the SPI clock
+    WRITE_PMC(AT91C_BASE_PMC, PMC_PCDR, (1 << pSpid->spiId));
+    
+    return 0;
+}
+
+//------------------------------------------------------------------------------
+/// Configures the parameters for the device corresponding to the cs.
+/// \param pSpid  Pointer to a Spid instance.
+/// \param cs  number corresponding to the SPI chip select.
+/// \param csr  SPI_CSR value to setup.
+//------------------------------------------------------------------------------
+void SPID_ConfigureCS(Spid *pSpid, unsigned char cs, unsigned int csr)
+{
+    AT91S_SPI *pSpiHw = pSpid->pSpiHw;
+    WRITE_SPI(pSpiHw, SPI_CSR[cs], csr);
+}
+    
+//------------------------------------------------------------------------------
+/// Starts a SPI master transfer. This is a non blocking function. It will
+/// return as soon as the transfer is started.
+/// Returns 0 if the transfer has been started successfully; otherwise returns
+/// SPID_ERROR_LOCK is the driver is in use, or SPID_ERROR if the command is not
+/// valid.
+/// \param pSpid  Pointer to a Spid instance.
+/// \param pCommand Pointer to the SPI command to execute.
+//------------------------------------------------------------------------------
+unsigned char SPID_SendCommand(Spid *pSpid, SpidCmd *pCommand)
+{
+    AT91S_SPI *pSpiHw = pSpid->pSpiHw;
+     unsigned int spiMr;
+         
+     // Try to get the dataflash semaphore
+     if (pSpid->semaphore == 0) {
+    
+         return SPID_ERROR_LOCK;
+    }
+     pSpid->semaphore--;
+
+    // Enable the SPI clock
+    WRITE_PMC(AT91C_BASE_PMC, PMC_PCER, (1 << pSpid->spiId));
+    
+    // Disable transmitter and receiver
+    WRITE_SPI(pSpiHw, SPI_PTCR, AT91C_PDC_RXTDIS | AT91C_PDC_TXTDIS);
+
+     // Write to the MR register
+     spiMr = READ_SPI(pSpiHw, SPI_MR);
+     spiMr |= AT91C_SPI_PCS;
+     spiMr &= ~((1 << pCommand->spiCs) << 16);
+    WRITE_SPI(pSpiHw, SPI_MR, spiMr);
+        
+    // Initialize the two SPI PDC buffer
+    WRITE_SPI(pSpiHw, SPI_RPR, (int) pCommand->pCmd);
+    WRITE_SPI(pSpiHw, SPI_RCR, pCommand->cmdSize);
+    WRITE_SPI(pSpiHw, SPI_TPR, (int) pCommand->pCmd);
+    WRITE_SPI(pSpiHw, SPI_TCR, pCommand->cmdSize);
+    
+    WRITE_SPI(pSpiHw, SPI_RNPR, (int) pCommand->pData);
+    WRITE_SPI(pSpiHw, SPI_RNCR, pCommand->dataSize);
+    WRITE_SPI(pSpiHw, SPI_TNPR, (int) pCommand->pData);
+    WRITE_SPI(pSpiHw, SPI_TNCR, pCommand->dataSize);
+
+    // Initialize the callback
+    pSpid->pCurrentCommand = pCommand;
+    
+    // Enable transmitter and receiver
+    WRITE_SPI(pSpiHw, SPI_PTCR, AT91C_PDC_RXTEN | AT91C_PDC_TXTEN);
+
+    // Enable buffer complete interrupt
+    WRITE_SPI(pSpiHw, SPI_IER, AT91C_SPI_RXBUFF);
+    
+    return 0;    
+}
+
+//------------------------------------------------------------------------------
+/// The SPI_Handler must be called by the SPI Interrupt Service Routine with the
+/// corresponding Spi instance.
+/// The SPI_Handler will unlock the Spi semaphore and invoke the upper application 
+/// callback.
+/// \param pSpid  Pointer to a Spid instance.
+//------------------------------------------------------------------------------
+void SPID_Handler(Spid *pSpid)
+{
+    SpidCmd *pSpidCmd = pSpid->pCurrentCommand;
+    AT91S_SPI *pSpiHw = pSpid->pSpiHw;
+    volatile unsigned int spiSr;
+    
+    // Read the status register
+    spiSr = READ_SPI(pSpiHw, SPI_SR);    
+    if (spiSr & AT91C_SPI_RXBUFF) {
+
+        // Disable transmitter and receiver
+        WRITE_SPI(pSpiHw, SPI_PTCR, AT91C_PDC_RXTDIS | AT91C_PDC_TXTDIS);
+
+        // Disable the SPI clock
+        WRITE_PMC(AT91C_BASE_PMC, PMC_PCDR, (1 << pSpid->spiId));
+
+        // Disable buffer complete interrupt
+        WRITE_SPI(pSpiHw, SPI_IDR, AT91C_SPI_RXBUFF);
+
+        // Release the dataflash semaphore
+        pSpid->semaphore++;
+            
+        // Invoke the callback associated with the current command
+        if (pSpidCmd && pSpidCmd->callback) {
+        
+            pSpidCmd->callback(0, pSpidCmd->pArgument);
+        }
+            
+        // Nothing must be done after. A new DF operation may have been started
+        // in the callback function.
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Returns 1 if the SPI driver is currently busy executing a command; otherwise
+/// returns 0.
+/// \param pSpid  Pointer to a SPI driver instance.
+//------------------------------------------------------------------------------
+unsigned char SPID_IsBusy(const Spid *pSpid)
+{
+    if (pSpid->semaphore == 0) {
+
+        return 1;
+    }
+    else {
+
+        return 0;
+    }
+}
+
diff --git a/usb-loader/samba_applets/at91lib/memories/spi-flash/spid.h b/usb-loader/samba_applets/at91lib/memories/spi-flash/spid.h
new file mode 100644
index 0000000000000000000000000000000000000000..5852c1cb5985660d8fa9bae01350b89102b49899
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/memories/spi-flash/spid.h
@@ -0,0 +1,183 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !!!Purpose
+/// 
+/// The Spi driver is a low level spi driver which performs SPI device Initializes, 
+/// spi transfer and receive. It can be used by upper SPI driver such as AT45 
+/// driver and AT26 driver. 
+///  
+/// !!!Usage
+/// 
+/// -# Initializes a SPI instance and the corresponding SPI hardware,
+///    Configure SPI in Master Mode using SPID_Configure().
+/// -# Configures the SPI characteristics (such as Clock Polarity, Phase, 
+///    transfers delay and Baud Rate) for the device corresponding to the
+///    chip select using SPID_ConfigureCS().
+/// -# Starts a SPI master transfer using SPID_SendCommand().
+///    The transfer is performed using the PDC channels. 
+///    -# It enable the SPI clock.
+///    -# Set the corresponding peripheral chip select.
+///    -# Initialize the two SPI PDC buffers.
+///       - Initialize SPI_TPR and SPI_TCR with SPI command data and size
+///         to send command data first.
+///       - Initialize SPI_RPR and SPI_RCR with SPI command data and size
+///         as dummy value.
+///       - Initialize SPI_TNPR and SPI_TNCR with rest of the data to be 
+///        transfered.(if the data specified in cmd structure)
+///       - Initialize SPI_RNPR and SPI_RNCR with rest of the data to be 
+///         received.(if the data specified in cmd structure)
+///    -# Initialize the callback function if specified.
+///    -# Enable transmitter and receiver.
+///    -# Example for sending a command to the dataflash through the SPI. 
+/// \code
+///      /// Build command to be sent.
+///      ...
+///      // Send Command and data through the SPI
+///      if (SPID_SendCommand(pAt45->pSpid, pCommand)) {
+///          return AT45_ERROR_SPI;
+///      }
+/// \endcode
+/// -# The SPI_Handler() must be called by the SPI Interrupt Service Routine 
+///    with the corresponding Spi instance. It is invokes to check for pending
+///    interrupts. 
+///    - Example for initializing SPI interrupt handler in upper application.
+/// \code
+///	      AIC_ConfigureIT(AT91C_ID_SPI, 0, SPI_Handler);
+/// \endcode
+//------------------------------------------------------------------------------
+
+#ifndef SPID_H
+#define SPID_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+/// An unspecified error has occured.
+#define SPID_ERROR          1
+
+/// SPI driver is currently in use.
+#define SPID_ERROR_LOCK     2
+
+//------------------------------------------------------------------------------
+//         Macros
+//------------------------------------------------------------------------------
+
+/// Calculates the value of the SCBR field of the Chip Select Register given
+/// MCK and SPCK.
+#define SPID_CSR_SCBR(mck, spck)    ((((mck) / (spck)) << 8) & AT91C_SPI_SCBR)
+
+/// Calculates the value of the DLYBS field of the Chip Select Register given
+/// the delay in ns and MCK.
+#define SPID_CSR_DLYBS(mck, delay) \
+    ((((((delay) * ((mck) / 1000000)) / 1000) + 1)  << 16) & AT91C_SPI_DLYBS)
+
+/// Calculates the value of the DLYBCT field of the Chip Select Register given
+/// the delay in ns and MCK.
+#define SPID_CSR_DLYBCT(mck, delay) \
+    ((((((delay) / 32 * ((mck) / 1000000)) / 1000) + 1) << 24) & AT91C_SPI_DLYBCT)
+
+//------------------------------------------------------------------------------
+//         Types
+//------------------------------------------------------------------------------
+
+/// SPI transfer complete callback.
+typedef void (*SpidCallback )(unsigned char, void *);
+
+//------------------------------------------------------------------------------
+/// Spi Transfer Request prepared by the application upper layer. This structure
+/// is sent to the SPI_SendCommand function to start the transfer. At the end of 
+/// the transfer, the callback is invoked by the interrupt handler.
+//------------------------------------------------------------------------------
+typedef struct _SpidCmd {
+
+    /// Pointer to the command data.
+	unsigned char *pCmd;
+    /// Command size in bytes.
+	unsigned char cmdSize;
+    /// Pointer to the data to be sent.
+	unsigned char *pData;
+    /// Data size in bytes.
+	unsigned short dataSize;
+    /// SPI chip select.
+	unsigned char spiCs;
+    /// Callback function invoked at the end of transfer.
+	SpidCallback callback;
+    /// Callback arguments.
+	void *pArgument;
+
+} SpidCmd;
+
+//------------------------------------------------------------------------------
+/// Constant structure associated with SPI port. This structure prevents
+/// client applications to have access in the same time.
+//------------------------------------------------------------------------------
+typedef struct {
+
+    /// Pointer to SPI Hardware registers
+	AT91S_SPI *pSpiHw;
+    /// SPI Id as defined in the product datasheet
+	char spiId;
+    /// Current SpiCommand being processed
+	SpidCmd *pCurrentCommand;
+    /// Mutual exclusion semaphore.
+	volatile char semaphore;
+
+} Spid;
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+extern unsigned char SPID_Configure(
+    Spid *pSpid,
+    AT91S_SPI *pSpiHw,
+    unsigned char spiId);
+
+extern void SPID_ConfigureCS(Spid *pSpid, unsigned char cs, unsigned int csr);
+	
+extern unsigned char SPID_SendCommand(
+	Spid *pSpid,
+	SpidCmd *pCommand);
+
+extern void SPID_Handler(Spid *pSpid);
+
+extern unsigned char SPID_IsBusy(const Spid *pSpid);
+
+#endif // #ifndef SPID_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.c b/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.c
new file mode 100644
index 0000000000000000000000000000000000000000..8a52eac7be844335cef96578ede8a1440331eac3
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.c
@@ -0,0 +1,301 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <stdio.h>
+#include <chipid/chipid.h>
+#include <string.h>
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+/// ChipID register, version field
+#define AT91C_CHIPID_CIDR_VERSION                     (0x1fUL << 0)
+#define AT91C_CHIPID_CIDR_VERSION_BITFLD              0
+#define AT91C_CHIPID_CIDR_VERSION_BITS                5
+/// ChipID register, embedded processor field
+#define AT91C_CHIPID_CIDR_EPROC                       (0x7UL << 5)
+#define AT91C_CHIPID_CIDR_EPROC_BITFLD                5
+#define AT91C_CHIPID_CIDR_EPROC_BITS                  3
+/// ChipID register, nonvolatile program memory size field
+#define AT91C_CHIPID_CIDR_NVPSIZ                      (0xfUL << 8)
+#define AT91C_CHIPID_CIDR_NVPSIZ_BITFLD               8
+#define AT91C_CHIPID_CIDR_NVPSIZ_BITS                 4
+/// ChipID register, second nonvolatile program memory size field
+#define AT91C_CHIPID_CIDR_NVPSIZ2                     (0xfUL << 12)
+#define AT91C_CHIPID_CIDR_NVPSIZ2_BITFLD              12
+#define AT91C_CHIPID_CIDR_NVPSIZ2_BITS                4
+/// ChipID register, Internal SRAM siize field
+#define AT91C_CHIPID_CIDR_SRAMSIZ                     (0xfUL << 16)
+#define AT91C_CHIPID_CIDR_SRAMSIZ_BITFLD              16
+#define AT91C_CHIPID_CIDR_SRAMSIZ_BITS                4
+/// ChipID register, Architecture identifier field
+#define AT91C_CHIPID_CIDR_ARCH                        (0xffUL << 20)
+#define AT91C_CHIPID_CIDR_ARCH_BITFLD                 20
+#define AT91C_CHIPID_CIDR_ARCH_BITS                   8
+/// ChipID register, nonvolatile program memory type field
+#define AT91C_CHIPID_CIDR_NVPTYP                      (0x7UL << 28)
+#define AT91C_CHIPID_CIDR_NVPTYP_BITFLD               28
+#define AT91C_CHIPID_CIDR_NVPTYP_BITS                 3
+/// ChipID register, extersion flag field
+#define AT91C_CHIPID_CIDR_EXT                         (0x1UL << 31)
+#define AT91C_CHIPID_CIDR_EXT_BITFLD                  31
+#define AT91C_CHIPID_CIDR_EXT_BITS                    1
+
+#define CHIPID_ID(chipid, bitfield, bits)   ((chipid >> bitfield) & ((1 << (bits)) - 1))
+
+//------------------------------------------------------------------------------
+//         Internal variables
+//------------------------------------------------------------------------------
+#define AT91C_CHIPID_EPROC_SIZE    5
+const struct ChipIDType CHIPID_eProc[AT91C_CHIPID_EPROC_SIZE] = {
+
+    // identifier       description
+    {0x1,   "ARM946ES"},
+    {0x2,   "ARM7TDMI"},
+    {0x3,   "Cortex-M3"},
+    {0x4,   "ARM920T"},
+    {0x5,   "ARM926EJS"},
+};
+
+#define AT91C_CHIPID_NVPSIZE_SIZE    16
+const struct ChipIDType CHIPID_nvpSiz[AT91C_CHIPID_NVPSIZE_SIZE] = {
+
+    // identifier       description
+    {0x0,   "None"},
+    {0x1,   "8K bytes"},
+    {0x2,   "16K bytes"},
+    {0x3,   "32K bytes"},
+    {0x4,   "Reserved"},
+    {0x5,   "64K bytes"},
+    {0x6,   "Reserved"},
+    {0x7,   "128K bytes"},
+    {0x8,   "Reserved"},
+    {0x9,   "256K bytes"},
+    {0xA,   "512K bytes"},
+    {0xB,   "Reserved"},
+    {0xC,   "1024K bytes"},
+    {0xD,   "Reserved"},
+    {0xE,   "2048K bytes"},
+    {0xF,   "Reserved"}
+};
+
+#define AT91C_CHIPID_NVPSIZE2_SIZE    16
+const struct ChipIDType CHIPID_nvpSiz2[AT91C_CHIPID_NVPSIZE2_SIZE] = {
+
+    // identifier       description
+    {0x0,   "None"},
+    {0x1,   "8K bytes"},
+    {0x2,   "16K bytes"},
+    {0x3,   "32K bytes"},
+    {0x4,   "Reserved"},
+    {0x5,   "64K bytes"},
+    {0x6,   "Reserved"},
+    {0x7,   "128K bytes"},
+    {0x8,   "Reserved"},
+    {0x9,   "256K bytes"},
+    {0xA,   "512K bytes"},
+    {0xB,   "Reserved"},
+    {0xC,   "1024K bytes"},
+    {0xD,   "Reserved"},
+    {0xE,   "2048K bytes"},
+    {0xF,   "Reserved"}
+};
+
+#define AT91C_CHIPID_SRAMSIZE_SIZE    16
+const struct ChipIDType CHIPID_sramSiz[AT91C_CHIPID_SRAMSIZE_SIZE] = {
+
+    // identifier       description
+    {0x0,   "48K bytes"},
+    {0x1,   "1K bytes"},
+    {0x2,   "2K bytes"},
+    {0x3,   "6K bytes"},
+    {0x4,   "112K bytes"},
+    {0x5,   "4K bytes"},
+    {0x6,   "80K bytes"},
+    {0x7,   "160K bytes"},
+    {0x8,   "8K bytes"},
+    {0x9,   "16K bytes"},
+    {0xA,   "32K bytes"},
+    {0xB,   "64K bytes"},
+    {0xC,   "128K bytes"},
+    {0xD,   "256K bytes"},
+    {0xE,   "96K bytes"},
+    {0xF,   "512K bytes"}
+};
+
+#define AT91C_CHIPID_ARCH_SIZE    22
+const struct ChipIDType CHIPID_archSiz[AT91C_CHIPID_ARCH_SIZE] = {
+
+    // identifier       description
+    {0x19,   "AT91SAM9xx Series"},
+    {0x29,   "AT91SAM9XExx Series"},
+    {0x34,   "AT91x34 series"},
+    {0x37,   "CAP7 Series"},
+    {0x39,   "CAP9 Series"},
+    {0x3B,   "CAP11 Series"},
+    {0x40,   "AT91x40 Series"},
+    {0x42,   "AT91x42 Series"},
+    {0x55,   "AT91x55 Series"},
+    {0x60,   "AT91SAM7Axx Series"},
+    {0x61,   "AT91SAM7AQxx Series"},
+    {0x63,   "AT91x63 Series"},
+    {0x70,   "AT91SAM7Sxx Series"},
+    {0x71,   "AT91SAM7XCxx Series"},
+    {0x72,   "AT91SAM7SExx Series"},
+    {0x73,   "AT91SAM7Lxx Series"},
+    {0x75,   "AT91SAM7Xxx Series"},
+    {0x76,   "AT91SAM7SLxx Series"},
+    {0x80,   "AT91SAM3Uxx Series"},
+    {0x81,   "AT91SAM3UExx Series"},
+    {0x92,   "AT91x92 Series"},
+    {0xF0,   "AT75Cxx Series"}
+};
+
+#define AT91C_CHIPID_NVPTYPE_SIZE    5
+const struct ChipIDType CHIPID_nvpTyp[AT91C_CHIPID_NVPTYPE_SIZE] = {
+
+    // identifier       description
+    {0x0,   "ROM"},
+    {0x1,   "ROMless or on-chip Flash"},
+    {0x4,   "SRAM emulating ROM"},
+    {0x2,   "Embedded Flash Memory"},
+    {0x3,   "ROM and Embedded Flash Memory, NVPSIZ is ROM size, NVPSIZ2 is Flash size"}
+};
+
+//------------------------------------------------------------------------------
+/// Internal functions
+//------------------------------------------------------------------------------
+unsigned char CHIPID_Find(const struct ChipIDType* pChipIDTypeList,
+                               unsigned int size,
+                               unsigned int id, 
+                               struct ChipIDType* pChipIDType)
+{
+    unsigned int i;
+
+    for(i=0; i<size; i++)
+    {
+        if(pChipIDTypeList[i].num == id)
+       	{
+            memcpy(pChipIDType, &pChipIDTypeList[i], sizeof(struct ChipIDType));
+            return 0;
+        }
+    }
+
+    return 1;
+}
+
+//------------------------------------------------------------------------------
+/// Exported functions
+//------------------------------------------------------------------------------
+unsigned char CHIPID_Get(ChipId* pChipId)
+{
+    unsigned int chipId, chipIdExt;
+
+    chipId = AT91C_BASE_DBGU->DBGU_CIDR;
+    chipIdExt = AT91C_BASE_DBGU->DBGU_EXID;
+
+    pChipId->version = CHIPID_ID(chipId, AT91C_CHIPID_CIDR_VERSION_BITFLD, AT91C_CHIPID_CIDR_VERSION_BITS);
+    pChipId->eProc = CHIPID_ID(chipId, AT91C_CHIPID_CIDR_EPROC_BITFLD, AT91C_CHIPID_CIDR_EPROC_BITS);
+    pChipId->nvpSiz = CHIPID_ID(chipId, AT91C_CHIPID_CIDR_NVPSIZ_BITFLD, AT91C_CHIPID_CIDR_NVPSIZ_BITS);
+    pChipId->nvpSiz2 = CHIPID_ID(chipId, AT91C_CHIPID_CIDR_NVPSIZ2_BITFLD, AT91C_CHIPID_CIDR_NVPSIZ2_BITS);
+    pChipId->sramSiz = CHIPID_ID(chipId, AT91C_CHIPID_CIDR_SRAMSIZ_BITFLD, AT91C_CHIPID_CIDR_SRAMSIZ_BITS);
+    pChipId->arch = CHIPID_ID(chipId, AT91C_CHIPID_CIDR_ARCH_BITFLD, AT91C_CHIPID_CIDR_ARCH_BITS);
+    pChipId->nvpTyp = CHIPID_ID(chipId, AT91C_CHIPID_CIDR_NVPTYP_BITFLD, AT91C_CHIPID_CIDR_NVPTYP_BITS);
+    pChipId->extFlag= CHIPID_ID(chipId, AT91C_CHIPID_CIDR_EXT_BITFLD, AT91C_CHIPID_CIDR_EXT_BITS);
+    pChipId->extID = chipIdExt;
+
+    return 0;
+}
+
+void CHIPID_Print(ChipId* pChipId)
+{
+    unsigned char status;
+    struct ChipIDType  chipIdType;
+
+    // Version
+    printf("Version                                   0x%x.\r\n", pChipId->version);
+
+    // Find Embedded Processor
+    status = CHIPID_Find(CHIPID_eProc, AT91C_CHIPID_EPROC_SIZE, pChipId->eProc, &chipIdType);
+    if(!status)
+    {
+        printf("Embedded Processor                        %s.\r\n", chipIdType.pStr);
+    }
+
+	// Find nonvolatile program memory size
+    status = CHIPID_Find(CHIPID_nvpSiz, AT91C_CHIPID_NVPSIZE_SIZE, pChipId->nvpSiz, &chipIdType);
+    if(!status)
+    {
+        printf("Nonvolatile program memory size           %s.\r\n", chipIdType.pStr);
+    }
+
+	// Find Second nonvolatile program memory size
+    status = CHIPID_Find(CHIPID_nvpSiz2, AT91C_CHIPID_NVPSIZE2_SIZE, pChipId->nvpSiz2, &chipIdType);
+    if(!status)
+    {
+        printf("Second nonvolatile program memory size    %s.\r\n", chipIdType.pStr);
+    }
+
+	// Find Internal SRAM size
+    status = CHIPID_Find(CHIPID_sramSiz, AT91C_CHIPID_SRAMSIZE_SIZE, pChipId->sramSiz, &chipIdType);
+    if(!status)
+    {
+        printf("Internal SRAM size                        %s.\r\n", chipIdType.pStr);
+    }
+
+	// Find Architecture identifier
+    status = CHIPID_Find(CHIPID_archSiz, AT91C_CHIPID_ARCH_SIZE, pChipId->arch, &chipIdType);
+    if(!status)
+    {
+        printf("Architecture identifier                   %s.\r\n", chipIdType.pStr);
+    }
+
+	// Find nonvolatile program memory type
+    status = CHIPID_Find(CHIPID_nvpTyp, AT91C_CHIPID_NVPTYPE_SIZE, pChipId->nvpTyp, &chipIdType);
+    if(!status)
+    {
+        printf("Nonvolatile program memory type           %s.\r\n", chipIdType.pStr);
+    }
+
+	// Find extension flag
+    if(pChipId->extFlag)
+    {
+        printf("Extended chip ID is                       0x%x. \r\n", pChipId->extID);
+    }
+    else
+    {
+        printf("Extended chip ID is not existed. \r\n");
+    }
+
+}
diff --git a/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.dir b/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.dir
new file mode 100644
index 0000000000000000000000000000000000000000..641a73001739608130302ed2a74a5ce363a2d085
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.dir
@@ -0,0 +1,36 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+///
+/// This directory contains an API for access the ChipID perpheral of AT91 microcontrollers.
+//------------------------------------------------------------------------------
\ No newline at end of file
diff --git a/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.h b/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.h
new file mode 100644
index 0000000000000000000000000000000000000000..f45067312fb8c23bf1ef2a6d19d532d36f9ceaca
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/chipid/chipid.h
@@ -0,0 +1,109 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+/// 
+/// Methods and definitions for access Chip ID peripheral in AT91 microcontrollers.
+/// 
+/// !Usage
+///
+/// -# 
+///
+//------------------------------------------------------------------------------
+
+#ifndef CHIPID_H
+#define CHIPID_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Definition for chip id register
+//------------------------------------------------------------------------------
+typedef struct _ChipId {
+
+   /// Version of the device
+   unsigned int version;
+   /// Embedded processor
+   unsigned int eProc;
+   /// Nonvolatile program memory size
+   unsigned int nvpSiz;
+   /// Second nonvolatile program memory size
+   unsigned int nvpSiz2;
+   /// Internal SRAM size
+   unsigned int sramSiz;
+   /// Architecture identifier
+   unsigned int arch;
+   /// Nonvolatile program memory type
+   unsigned int nvpTyp;
+   /// Extension flag
+   unsigned int extFlag;
+   /// Chip ID extersion extension
+   unsigned int extID;
+}ChipId;
+
+#if 1
+struct ChipIDType {
+
+   /// Identifier
+   unsigned int num;
+   /// Type
+   unsigned char pStr[80];
+};
+#else
+typedef struct _ChipIDType {
+
+   /// Identifier
+   unsigned int num;
+   /// Type
+   unsigned char pStr[80];
+}ChipIDType;
+#endif
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+/// Get chip ID
+extern unsigned char CHIPID_Get(ChipId* pChipId);
+
+/// Print chip ID
+extern void CHIPID_Print(ChipId* pChipId);
+
+#endif //#ifndef CHIPID_H
\ No newline at end of file
diff --git a/usb-loader/samba_applets/at91lib/peripherals/cp15/core.h b/usb-loader/samba_applets/at91lib/peripherals/cp15/core.h
new file mode 100644
index 0000000000000000000000000000000000000000..3de96ea381ba298e57cdf1e3a44459d1068578cd
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/cp15/core.h
@@ -0,0 +1,88 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+// core list
+//-------------------
+// arm7tdmi
+// arm926ej_s
+// arm1176jzf_s
+// cortexm3
+
+#include "board.h"
+
+#ifndef _CORE_H
+#define _CORE_H
+
+#if defined(at91sam7a3) \
+    || defined(at91sam7l) \
+    || defined(at91sam7s32) \
+    || defined(at91sam7s321) \
+    || defined(at91sam7s64) \
+    || defined(at91sam7s128) \
+    || defined(at91sam7s256) \
+    || defined(at91sam7s512) \
+    || defined(at91sam7se32) \
+    || defined(at91sam7se256) \
+    || defined(at91sam7se512) \
+    || defined(at91sam7x128) \
+    || defined(at91sam7x256) \
+    || defined(at91sam7x512) \
+    || defined(at91sam7xc128) \
+    || defined(at91sam7xc256) \
+    || defined(at91sam7xc512)
+
+#define arm7tdmi
+
+#elif  defined(at91cap9) \
+    || defined(at91sam9260) \
+    || defined(at91sam9261) \
+    || defined(at91sam9263) \
+    || defined(at91sam9g20) \
+    || defined(at91sam9m10) \
+    || defined(at91sam9m11) \
+    || defined(at91sam9rl) \
+    || defined(at91sam9xe)
+
+#define arm926ej_s
+
+#elif defined(at91cap11)
+
+#define arm1176jzf_s
+
+#elif defined(at91sam3u)
+
+#define cortexm3
+
+#else
+
+#error ARM core not defined!
+
+#endif
+
+#endif // #ifndef _CORE_H
\ No newline at end of file
diff --git a/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.c b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.c
new file mode 100644
index 0000000000000000000000000000000000000000..6a891870f3825d717b154ada5eeb720b4c652853
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.c
@@ -0,0 +1,319 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//-----------------------------------------------------------------------------
+// Reg Reads                    Writes
+//----------------------------------------------------------------------------
+// 0   ID code                  Unpredictable
+// 0   cache type               Unpredictable
+// 0   TCM status               Unpredictable
+// 1   Control                  Control
+// 2   Translation table base   Translation table base
+// 3   Domain access control    Domain access control
+// 4                                                       (Reserved)    
+// 5   Data fault status        Data fault status
+// 5   Instruction fault status Instruction fault status
+// 6   Fault address            Fault address
+// 7   cache operations         cache operations
+// 8   Unpredictable            TLB operations
+// 9   cache lockdown           cache lockdown
+// 9   TCM region               TCM region
+// 10  TLB lockdown             TLB lockdown
+// 11                                                      (Reserved) 
+// 12                                                      (Reserved) 
+// 13  FCSE PID                 FCSE PID
+// 13  Context ID               Context ID
+// 14                                                      (Reserved)             
+// 15  Test configuration       Test configuration
+//-----------------------------------------------------------------------------
+
+//-----------------------------------------------------------------------------
+//         Headers
+//-----------------------------------------------------------------------------
+
+#include <board.h>
+
+#ifdef CP15_PRESENT
+
+#include <utility/trace.h>
+#include "cp15.h"
+
+#if defined(__ICCARM__)
+#include <intrinsics.h>
+#endif
+
+
+//-----------------------------------------------------------------------------
+//         Macros
+//-----------------------------------------------------------------------------
+
+//-----------------------------------------------------------------------------
+//         Defines
+//-----------------------------------------------------------------------------
+
+
+//-----------------------------------------------------------------------------
+//         Global functions
+//-----------------------------------------------------------------------------
+
+
+///////////////////////////////////////////////////////////////////////////////
+/// CP15 c1
+/// * I cache
+/// * D cache
+///////////////////////////////////////////////////////////////////////////////
+
+//------------------------------------------------------------------------------
+/// Check Instruction cache
+/// \return 0 if I_cache disable, 1 if I_cache enable
+//------------------------------------------------------------------------------
+unsigned int CP15_IsIcacheEnabled(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+    return ((control & (1 << CP15_I_BIT)) != 0);
+} 
+
+//------------------------------------------------------------------------------
+/// Enable Instruction cache
+//------------------------------------------------------------------------------
+void CP15_EnableIcache(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+
+    // Check if cache is disabled
+    if ((control & (1 << CP15_I_BIT)) == 0) {
+
+        control |= (1 << CP15_I_BIT);
+        CP15_WriteControl(control);        
+        TRACE_INFO("I cache enabled.\n\r");
+    }
+#if !defined(OP_BOOTSTRAP_on)
+    else {
+
+        TRACE_INFO("I cache is already enabled.\n\r");
+    }
+#endif
+}
+
+//------------------------------------------------------------------------------
+/// Disable Instruction cache
+//------------------------------------------------------------------------------
+void CP15_DisableIcache(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+
+    // Check if cache is enabled
+    if ((control & (1 << CP15_I_BIT)) != 0) {
+
+        control &= ~(1 << CP15_I_BIT);
+        CP15_WriteControl(control);        
+        TRACE_INFO("I cache disabled.\n\r");
+    }
+    else {
+
+        TRACE_INFO("I cache is already disabled.\n\r");
+    }
+} 
+
+//------------------------------------------------------------------------------
+/// Check MMU
+/// \return 0 if MMU disable, 1 if MMU enable
+//------------------------------------------------------------------------------
+unsigned int CP15_IsMMUEnabled(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+    return ((control & (1 << CP15_M_BIT)) != 0);
+} 
+
+//------------------------------------------------------------------------------
+/// Enable MMU
+//------------------------------------------------------------------------------
+void CP15_EnableMMU(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+
+    // Check if MMU is disabled
+    if ((control & (1 << CP15_M_BIT)) == 0) {
+
+        control |= (1 << CP15_M_BIT);
+        CP15_WriteControl(control);        
+        TRACE_INFO("MMU enabled.\n\r");
+    }
+    else {
+
+        TRACE_INFO("MMU is already enabled.\n\r");
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Disable MMU
+//------------------------------------------------------------------------------
+void CP15_DisableMMU(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+
+    // Check if MMU is enabled
+    if ((control & (1 << CP15_M_BIT)) != 0) {
+
+        control &= ~(1 << CP15_M_BIT);
+        control &= ~(1 << CP15_C_BIT);
+        CP15_WriteControl(control);        
+        TRACE_INFO("MMU disabled.\n\r");
+    }
+    else {
+
+        TRACE_INFO("MMU is already disabled.\n\r");
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Check D_cache
+/// \return 0 if D_cache disable, 1 if D_cache enable (with MMU of course)
+//------------------------------------------------------------------------------
+unsigned int CP15_IsDcacheEnabled(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+    return ((control & ((1 << CP15_C_BIT)||(1 << CP15_M_BIT))) != 0);
+} 
+
+//------------------------------------------------------------------------------
+/// Enable Data cache
+//------------------------------------------------------------------------------
+void CP15_EnableDcache(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+
+    if( !CP15_IsMMUEnabled() ) {
+        TRACE_ERROR("Do nothing: MMU not enabled\n\r");
+    }
+    else {
+        // Check if cache is disabled
+        if ((control & (1 << CP15_C_BIT)) == 0) {
+
+            control |= (1 << CP15_C_BIT);
+            CP15_WriteControl(control);        
+            TRACE_INFO("D cache enabled.\n\r");
+        }
+        else {
+
+            TRACE_INFO("D cache is already enabled.\n\r");
+        }
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Disable Data cache
+//------------------------------------------------------------------------------
+void CP15_DisableDcache(void)
+{
+    unsigned int control;
+
+    control = CP15_ReadControl();
+
+    // Check if cache is enabled
+    if ((control & (1 << CP15_C_BIT)) != 0) {
+
+        control &= ~(1 << CP15_C_BIT);
+        CP15_WriteControl(control);        
+        TRACE_INFO("D cache disabled.\n\r");
+    }
+    else {
+
+        TRACE_INFO("D cache is already disabled.\n\r");
+    }
+}
+
+//----------------------------------------------------------------------------
+/// Lock I cache
+/// \param I cache index
+//----------------------------------------------------------------------------
+void CP15_LockIcache(unsigned int index)
+{
+    unsigned int victim = 0;
+
+    // invalidate all the cache (4 ways) 
+    CP15_InvalidateIcache();
+    
+    // lockdown all the ways except this in parameter
+    victim =  CP15_ReadIcacheLockdown();
+    victim = 0;
+    victim |= ~index;
+    victim &= 0xffff;
+    CP15_WriteIcacheLockdown(victim);
+}
+
+//----------------------------------------------------------------------------
+/// Lock D cache
+/// \param D cache way
+//----------------------------------------------------------------------------
+void CP15_LockDcache(unsigned int index)
+{
+    unsigned int victim = 0;
+
+    // invalidate all the cache (4 ways)    
+    CP15_InvalidateDcache();
+    
+    // lockdown all the ways except this in parameter    
+    victim =  CP15_ReadDcacheLockdown();
+    victim = 0;
+    victim |= ~index;
+    victim &= 0xffff;
+    CP15_WriteDcacheLockdown(victim);
+}
+
+//----------------------------------------------------------------------------
+/// Lock D cache
+/// \param D cache way
+//----------------------------------------------------------------------------
+void CP15_ShutdownDcache(void)
+{ 
+    CP15_TestCleanInvalidateDcache();  
+    CP15_DrainWriteBuffer();
+    CP15_DisableDcache();
+    CP15_InvalidateTLB();      
+}
+
+#endif // CP15_PRESENT
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.dir b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.dir
new file mode 100644
index 0000000000000000000000000000000000000000..171ea0be87d06cb8396fc92f62e1565386252593
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.dir
@@ -0,0 +1,37 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+///
+/// Contains the API for coprocessor 15.
+//------------------------------------------------------------------------------
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.h b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.h
new file mode 100644
index 0000000000000000000000000000000000000000..462ae9cc2ccd0792dae060aa76de9d4b9b62971a
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15.h
@@ -0,0 +1,195 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+/// 
+/// Methods to manage the Coprocessor 15. Coprocessor 15, or System Control 
+/// Coprocessor CP15, is used to configure and control all the items in the 
+/// list below:
+/// • ARM core
+/// • caches (Icache, Dcache and write buffer)
+/// • TCM
+/// • MMU
+/// • Other system options
+/// 
+/// !Usage
+///
+/// -# Enable or disable D cache with Enable_D_cache and Disable_D_cache
+/// -# Enable or disable I cache with Enable_I_cache and Disable_I_cache
+///
+//------------------------------------------------------------------------------
+
+#ifndef _CP15_H
+#define _CP15_H
+
+#ifdef CP15_PRESENT
+
+//-----------------------------------------------------------------------------
+//         Defines
+//-----------------------------------------------------------------------------
+
+#define CP15_L4_BIT 15 // Determines if the T bit is set when load instructions 
+                       // change the PC: 
+                       // 0 = loads to PC set the T bit 
+                       // 1 = loads to PC do not set T bit
+
+#define CP15_RR_BIT 14 // RR bit Replacement strategy for Icache and Dcache: 
+                       // 0 = Random replacement 
+                       // 1 = Round-robin replacement.
+                      
+#define CP15_V_BIT  13 // V bit Location of exception vectors: 
+                       // 0 = Normal exception vectors selected address range = 0x0000 0000 to 0x0000 001C 
+                       // 1 = High exception vect selected, address range = 0xFFFF 0000 to 0xFFFF 001C
+                       
+#define CP15_I_BIT  12 // I bit Icache enable/disable: 
+                       // 0 = Icache disabled 
+                       // 1 = Icache enabled
+                       
+#define CP15_R_BIT   9 // R bit ROM protection
+
+#define CP15_S_BIT   8 // S bit System protection
+                  
+#define CP15_B_BIT   7 // B bit Endianness: 
+                       // 0 = Little-endian operation 
+                       // 1 = Big-endian operation.                  
+                     
+#define CP15_C_BIT   2 // C bit Dcache enable/disable: 
+                       // 0 = cache disabled 
+                       // 1 = cache enabled
+
+#define CP15_A_BIT   1 // A bit Alignment fault enable/disable:
+                       // 0 = Data address alignment fault checking disabled
+                       // 1 = Data address alignment fault checking enabled
+
+#define CP15_M_BIT   0 // M bit MMU enable/disable: 0 = disabled 1 = enabled.
+                       // 0 = disabled 
+                       // 1 = enabled
+
+// No access Any access generates a domain fault.
+#define CP15_DOMAIN_NO_ACCESS      0x00  
+// Client Accesses are checked against the access permission bits in the section or page descriptor.
+#define CP15_DOMAIN_CLIENT_ACCESS  0x01  
+// Manager Accesses are not checked against the access permission bits so a permission fault cannot be generated.
+#define CP15_DOMAIN_MANAGER_ACCESS 0x03  
+
+//-----------------------------------------------------------------------------
+//         External functions defined in cp15_asm.S
+//-----------------------------------------------------------------------------
+
+// c0
+extern unsigned int CP15_ReadID(void);
+extern unsigned int CP15_ReadCacheType(void);
+extern unsigned int CP15_ReadTCMStatus(void);
+
+// c1
+extern unsigned int CP15_ReadControl(void);
+extern void         CP15_WriteControl(unsigned int value);
+
+// c2
+extern unsigned int CP15_ReadTTB(void);
+extern void         CP15_WriteTTB(unsigned int value);
+
+// c3
+extern unsigned int CP15_ReadDomainAccessControl(void);
+extern void         CP15_WriteDomainAccessControl(unsigned int value);
+
+// c5
+// CP15_ReadDFSR
+// CP15_writeDFSR
+// CP15_ReadIFSR
+// CP15_WriteIFSR
+
+// c6
+// CP15_ReadFAR
+// CP15_writeFAR
+
+// c7  
+extern void         CP15_InvalidateIDcache(void);
+extern void         CP15_InvalidateDcache(void);
+extern void         CP15_InvalidateIcache(void);
+extern void         CP15_PrefetchIcacheLine(unsigned int value);
+extern void         CP15_TestCleanInvalidateDcache(void);
+extern void         CP15_DrainWriteBuffer(void);
+extern void         CP15_WaitForInterrupt(void);
+
+// c8
+extern void         CP15_InvalidateTLB(void);
+extern void         CP15_InvalidateTLBMVA(unsigned int mva);
+extern void         CP15_InvalidateITLB(void);
+extern void         CP15_InvalidateITLBMVA(unsigned int mva);
+extern void         CP15_InvalidateDTLB(void);
+extern void         CP15_InvalidateDTLBMVA(unsigned int mva);
+
+// c9
+extern unsigned int CP15_ReadDcacheLockdown(void);
+extern void         CP15_WriteDcacheLockdown(unsigned int value);
+extern unsigned int CP15_ReadIcacheLockdown(void);
+extern void         CP15_WriteIcacheLockdown(unsigned int value);
+
+// c10
+// CP15_ReadTLBLockdown:
+// CP15_WriteTLBLockdown:
+
+// c13
+// CP15_ReadFCSE_PID
+// CP15_WriteFCSE_PID
+
+//-----------------------------------------------------------------------------
+//         Exported functions from CP15.c
+//-----------------------------------------------------------------------------
+
+// MMU (Status/Enable/Disable)
+extern unsigned int CP15_IsMMUEnabled(void);
+extern void         CP15_EnableMMU(void);
+extern void         CP15_DisableMMU(void);
+
+// I cache (Status/Enable/Disable)
+extern unsigned int CP15_IsIcacheEnabled(void);
+extern void         CP15_EnableIcache(void);
+extern void         CP15_DisableIcache(void);
+
+// D cache (Status/Enable/Disable)
+extern unsigned int CP15_IsDcacheEnabled(void);
+extern void         CP15_EnableDcache(void);
+extern void         CP15_DisableDcache(void);
+
+// complex functions
+extern void         CP15_LockIcache(unsigned int way);
+extern void         CP15_LockDcache(unsigned int way);
+
+extern void         CP15_ShutdownDcache(void);
+
+
+#endif // CP15_PRESENT
+
+#endif // #ifndef _CP15_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_gcc.S b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_gcc.S
new file mode 100644
index 0000000000000000000000000000000000000000..6407909c782d87bacf43984aaf45d264adefe4de
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_gcc.S
@@ -0,0 +1,607 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "board.h"
+
+#ifdef CP15_PRESENT
+
+//------------------------------------------------------------------------------
+/// Functions to access CP15 coprocessor register
+//------------------------------------------------------------------------------
+        // c0
+        .global CP15_ReadCacheType
+        .global CP15_ReadTCMStatus
+        // c1        
+        .global CP15_ReadControl
+        .global CP15_WriteControl
+        // c2        
+        // c3        
+        .global CP15_ReadDomainAccessControl
+        .global CP15_WriteDomainAccessControl
+        // c7        
+        .global CP15_InvalidateIDcache
+        .global CP15_InvalidateDcache
+        .global CP15_InvalidateIcache
+        .global CP15_PrefetchIcacheLine
+        .global CP15_TestCleanInvalidateDcache
+        .global CP15_DrainWriteBuffer
+        .global CP15_WaitForInterrupt
+        // c8        
+        .global CP15_InvalidateTLB
+        .global CP15_InvalidateTLBMVA
+        .global CP15_InvalidateITLB
+        .global CP15_InvalidateITLBMVA
+        .global CP15_InvalidateDTLB
+        .global CP15_InvalidateDTLBMVA    
+        // c9        
+        .global CP15_ReadDcacheLockdown
+        .global CP15_WriteDcacheLockdown
+        .global CP15_ReadIcacheLockdown 
+        .global CP15_WriteIcacheLockdown
+        .global CP15_ReadTLBLockdown
+        .global CP15_WriteTLBLockdown 
+        // c13        
+        .global CP15_ReadTLBLockdown
+        .global CP15_WriteTLBLockdown        
+        // c13        
+        .global CP15_ReadFCSE_PID
+        .global CP15_WriteFCSE_PID
+
+//------------------------------------------------------------------------------
+/// c0
+/// Register c0 accesses the ID Register, Cache Type Register, and TCM Status Registers.
+/// Reading from this register returns the device ID, the cache type, or the TCM status
+/// depending on the value of Opcode_2 used:
+/// Opcode_2 = 0 ID value.
+/// Opcode_2 = 1 instruction and data cache type.
+/// Opcode_2 = 2 TCM status.
+//------------------------------------------------------------------------------
+
+       .section    .CP15_ReadID
+       .global      CP15_ReadID
+// C0 read ID
+CP15_ReadID:
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 0
+        bx      lr
+
+	.section .CP15_ReaDcacheType
+	.global   CP15_ReaDcacheType
+// C0 read Cache Type
+CP15_ReaDcacheType:
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 1
+        bx      lr
+
+// C0 read TCM status
+	.section .CP15_ReadTCMStatus
+	.global   CP15_ReadTCMStatus
+CP15_ReadTCMStatus:
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 2
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Control Register c1
+/// Register c1 is the Control Register for the ARM926EJ-S processor.
+/// This register specifies the configuration used to enable and disable the
+/// caches and MMU. It is recommended that you access this register using a
+/// read-modify-write sequence.
+//------------------------------------------------------------------------------
+	.section .CP15_ReadControl
+        .global   CP15_ReadControl
+// CP15 Read Control Register
+CP15_ReadControl:
+        mov     r0, #0
+        mrc     p15, 0, r0, c1, c0, 0   
+        bx      lr
+
+// CP15 Write Control Register
+	.section .CP15_WriteControl
+        .global   CP15_WriteControl
+CP15_WriteControl:
+        mcr     p15, 0, r0, c1, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop        
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Translation Table Base Register c2
+/// Register c2 is the Translation Table Base Register (TTBR), for the base
+/// address of the first-level translation table.
+/// Reading from c2 returns the pointer to the currently active first-level
+/// translation table in bits [31:14] and an Unpredictable value in bits [13:0].
+/// Writing to register c2 updates the pointer to the first-level translation
+/// table from the value in bits [31:14] of the written value. Bits [13:0]
+/// Should Be Zero.
+/// You can use the following instructions to access the TTBR:
+/// Read TTBR  : MRC p15, 0, <Rd>, c2, c0, 0
+/// Write TTBR : MCR p15, 0, <Rd>, c2, c0, 0
+//------------------------------------------------------------------------------
+	.section .CP15_ReadTTB
+	.global   CP15_ReadTTB
+CP15_ReadTTB:
+        mov     r0, #0
+        mrc     p15, 0, r0, c2, c0, 0
+        bx      lr
+
+	.section .CP15_WriteTTB
+	.global   CP15_WriteTTB
+CP15_WriteTTB:
+        mcr     p15, 0, r0, c2, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Domain Access Control Register c3
+/// Read domain access permissions  : MRC p15, 0, <Rd>, c3, c0, 0
+/// Write domain access permissions : MCR p15, 0, <Rd>, c3, c0, 0
+//------------------------------------------------------------------------------
+	.section .CP15_ReadDomainAccessControl
+	.global   CP15_ReadDomainAccessControl
+CP15_ReadDomainAccessControl:
+        mov     r0, #0
+        mrc     p15, 0, r0, c3, c0, 0
+        bx      lr
+
+	.section .CP15_WriteDomainAccessControl
+	.global   CP15_WriteDomainAccessControl
+CP15_WriteDomainAccessControl:
+        mcr     p15, 0, r0, c3, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Fault Status Registers Register c5
+/// Register c5 accesses the Fault Status Registers (FSRs). The FSRs contain the source of
+/// the last instruction or data fault. The instruction-side FSR is intended for debug
+/// purposes only. The FSR is updated for alignment faults, and external aborts that occur
+/// while the MMU is disabled.
+/// The FSR accessed is determined by the value of the Opcode_2 field:
+/// Opcode_2 = 0  Data Fault Status Register (DFSR).
+/// Opcode_2 = 1  Instruction Fault Status Register (IFSR).
+/// The fault type encoding is listed in Table 3-9 on page 3-22.
+/// You can access the FSRs using the following instructions:
+/// MRC p15, 0, <Rd>, c5, c0, 0 ;read DFSR
+/// MCR p15, 0, <Rd>, c5, c0, 0 ;write DFSR
+/// MRC p15, 0, <Rd>, c5, c0, 1 ;read IFSR
+/// MCR p15, 0, <Rd>, c5, c0, 1 ;write IFSR
+//------------------------------------------------------------------------------
+
+	.section .CP15_ReadDFSR
+	.global   CP15_ReadDFSR
+CP15_ReadDFSR:
+        mov     r0, #0
+        mrc     p15, 0, r0, c5, c0, 0
+        bx      lr
+
+	.section .CP15_writeDFSR
+	.global   CP15_writeDFSR
+CP15_writeDFSR:
+        mcr     p15, 0, r0, c5, c0, 0
+        bx      lr
+
+	.section .CP15_ReadIFSR
+	.global   CP15_ReadIFSR
+CP15_ReadIFSR:
+        mov     r0, #0
+        mrc     p15, 0, r0, c5, c0, 1
+        bx      lr
+
+	.section .CP15_WriteIFSR
+	.global   CP15_WriteIFSR
+CP15_WriteIFSR:
+        mcr     p15, 0, r0, c5, c0, 1
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Fault Address Register c6
+/// Register c6 accesses the Fault Address Register (FAR). The FAR contains the Modified
+/// Virtual Address of the access being attempted when a Data Abort occurred. The FAR is
+/// only updated for Data Aborts, not for Prefetch Aborts. The FAR is updated for
+/// alignment faults, and external aborts that occur while the MMU is disabled.
+/// You can use the following instructions to access the FAR:
+/// MRC p15, 0, <Rd>, c6, c0, 0 ; read FAR
+/// MCR p15, 0, <Rd>, c6, c0, 0 ; write FAR
+//------------------------------------------------------------------------------
+	.section .CP15_ReadFAR
+	.global   CP15_ReadFAR
+CP15_ReadFAR:
+        mov     r0, #0
+        mrc     p15, 0, r0, c6, c0, 0
+        bx      lr
+
+	.section .CP15_writeFAR
+	.global   CP15_writeFAR
+CP15_writeFAR:
+        mcr     p15, 0, r0, c6, c0, 0
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Control functions caches and the write buffer c7
+/// Register c7 controls the caches and the write buffer. The function of each cache
+/// operation is selected by the Opcode_2 and CRm fields in the MCR instruction used to
+/// write to CP15 c7. Writing other Opcode_2 or CRm values is Unpredictable.
+/// Reading from CP15 c7 is Unpredictable, with the exception of the two test and clean
+/// operations (see Table 2-18 on page 2-21 and Test and clean operations on page 2-23).
+/// You can use the following instruction to write to c7:
+/// MCR p15, <Opcode_1>, <Rd>, <CRn>, <CRm>, <Opcode_2>
+//------------------------------------------------------------------------------
+/// Invalidate Icache and Dcache                        MCR p15, 0, <Rd>, c7, c7, 0
+/// Invalidate Icache                                   MCR p15, 0, <Rd>, c7, c5, 0
+/// Invalidate Icache single entry (MVA) MVA            MCR p15, 0, <Rd>, c7, c5, 1
+/// Invalidate Icache single entry (Set/Way) Set/Way    MCR p15, 0, <Rd>, c7, c5, 2
+/// Prefetch Icache line (MVA) MVA                      MCR p15, 0, <Rd>, c7, c13, 1
+/// Invalidate Dcache                                   MCR p15, 0, <Rd>, c7, c6, 0
+/// Invalidate Dcache single entry (MVA) MVA            MCR p15, 0, <Rd>, c7, c6, 1
+/// Invalidate Dcache single entry (Set/Way) Set/Way    MCR p15, 0, <Rd>, c7, c6, 2
+/// Clean Dcache single entry (MVA) MVA                 MCR p15, 0, <Rd>, c7, c10, 1
+/// Clean Dcache single entry (Set/Way) Set/Way         MCR p15, 0, <Rd>, c7, c10, 2
+/// Test and clean Dcache -                             MRC p15, 0, <Rd>, c7, c10, 3
+/// Clean and invalidate Dcache entry (MVA)  MVA        MCR p15, 0, <Rd>, c7, c14, 1
+/// Clean and invalidate Dcache entry (Set/Way) Set/Way MCR p15, 0, <Rd>, c7, c14, 2
+/// Test, clean, and invalidate Dcache -                MRC p15, 0, <Rd>, c7, c14, 3
+/// Drain write buffer SBZ                              MCR p15, 0, <Rd>, c7, c10, 4
+/// Wait for interrupt SBZ                              MCR p15, 0, <Rd>, c7, c0, 4
+//------------------------------------------------------------------------------
+
+// Invalidate Icache and Dcache
+	.section .CP15_InvalidateIDcache
+	.global   CP15_InvalidateIDcache
+CP15_InvalidateIDcache:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c7, 0        
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+        
+// Invalidate Icache
+	.section .CP15_InvalidateIcache
+	.global   CP15_InvalidateIcache
+CP15_InvalidateIcache:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c5, 0     
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+// Invalidate Dcache
+	.section .CP15_InvalidateDcache
+	.global   CP15_InvalidateDcache
+CP15_InvalidateDcache:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c6, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Prefetch Icache line c7
+/// Performs an Icache lookup of the specified modified virtual address.
+/// If the cache misses, and the region is cacheable, a linefill is performed.
+/// Prefetch Icache line (MVA): MCR p15, 0, <Rd>, c7, c13, 1
+//------------------------------------------------------------------------------
+	.section .CP15_PrefetchIcacheLine
+	.global   CP15_PrefetchIcacheLine
+CP15_PrefetchIcacheLine:
+        mcr     p15, 0, r0, c7, c13, 1
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Test, clean, and invalidate Dcache c7
+/// As for test and clean, except that when the entire cache has 
+/// been tested and cleaned, it is invalidated.
+//------------------------------------------------------------------------------
+	.section .CP15_TestCleanInvalidateDcache
+	.global   CP15_TestCleanInvalidateDcache
+CP15_TestCleanInvalidateDcache:
+        mrc     p15, 0, r0, c7, c14, 3
+        bne     CP15_TestCleanInvalidateDcache
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Drain write buffer c7
+/// This instruction acts as an explicit memory barrier. It drains 
+/// the contents of the write buffers of all memory stores 
+/// occurring in program order before this instruction is 
+/// completed. No instructions occurring in program order 
+/// after this instruction are executed until it completes. This 
+/// can be used when timing of specific stores to the level two 
+/// memory system has to be controlled (for example, when a 
+/// store to an interrupt acknowledge location has to complete 
+/// before interrupts are enabled).
+//------------------------------------------------------------------------------
+	.section .CP15_DrainWriteBuffer
+	.global   CP15_DrainWriteBuffer
+CP15_DrainWriteBuffer:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c10, 4
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Wait For Interrupt operation c7
+/// The purpose of the Wait For Interrupt operation is to put the processor in
+/// to a low power state.
+/// This puts the processor into a low-power state and stops it executing more
+/// instructions until an interrupt, or debug request occurs, regardless of
+/// whether the interrupts are disabled by the masks in the CPSR.
+/// When an interrupt does occur, the mcr instruction completes and the IRQ or
+/// FIQ handler is entered as normal. The return link in r14_irq or r14_fiq
+/// contains the address of the mcr instruction plus 8, so that the normal
+/// instruction used for interrupt return (SUBS PC,R14,#4) returns to the
+/// instruction following the mcr.
+/// Wait For Interrupt : MCR p15, 0, <Rd>, c7, c0, 4
+//------------------------------------------------------------------------------
+	.section .CP15_WaitForInterrupt
+	.global   CP15_WaitForInterrupt
+CP15_WaitForInterrupt:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c0, 4
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Translation Lookaside Buffer (TLB) : c8
+/// This is a write-only register used to control the Translation Lookaside Buffer (TLB).
+/// There is a single TLB used to hold entries for both data and instructions. The TLB is
+/// divided into two parts:
+/// • a set-associative part
+/// • a fully-associative part.
+/// The fully-associative part (also referred to as the lockdown part of the TLB) is used to
+/// store entries to be locked down. Entries held in the lockdown part of the TLB are
+/// preserved during an invalidate TLB operation. Entries can be removed from the
+/// lockdown TLB using an invalidate TLB single entry operation.
+/// Six TLB operations are defined, and the function to be performed is selected by the
+/// Opcode_2 and CRm fields in the MCR instruction used to write CP15 c8. Writing other
+/// Opcode_2 or CRm values is Unpredictable. Reading from this register is Unpredictable.
+//------------------------------------------------------------------------------
+/// Invalidate TLB                                 MCR p15, 0, <Rd>, c8, c7, 0
+/// Invalidate TLB single entry (MVA)              MCR p15, 0, <Rd>, c8, c7, 1
+/// Invalidate instruction TLB                     MCR p15, 0, <Rd>, c8, c5, 0
+/// Invalidate instruction TLB single entry (MVA)  MCR p15, 0, <Rd>, c8, c5, 1
+/// Invalidate data TLB                            MCR p15, 0, <Rd>, c8, c6, 0
+/// Invalidate data TLB single entry (MVA)         MCR p15, 0, <Rd>, c8, c6, 1
+//------------------------------------------------------------------------------
+
+	.section .CP15_InvalidateTLB
+	.global   CP15_InvalidateTLB
+CP15_InvalidateTLB:
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c7, 0
+        bx      lr
+
+	.section .CP15_InvalidateTLBMVA
+	.global   CP15_InvalidateTLBMVA
+CP15_InvalidateTLBMVA:
+        mcr     p15, 0, r0, c8, c7, 1
+        bx      lr
+
+	.section .CP15_InvalidateITLB
+	.global   CP15_InvalidateITLB
+CP15_InvalidateITLB:
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c5, 0
+        bx      lr
+
+	.section .CP15_InvalidateITLBMVA
+	.global   CP15_InvalidateITLBMVA
+CP15_InvalidateITLBMVA:
+        mcr     p15, 0, r0, c8, c5, 1
+        bx      lr
+
+	.section .CP15_InvalidateDTLB
+	.global   CP15_InvalidateDTLB
+CP15_InvalidateDTLB:
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c6, 0
+        bx      lr
+
+	.section .CP15_InvalidateDTLBMVA
+	.global   CP15_InvalidateDTLBMVA
+CP15_InvalidateDTLBMVA:
+        mcr     p15, 0, r0, c8, c6, 1
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Cache Lockdown Register c9
+/// The Cache Lockdown Register uses a cache-way-based locking scheme (Format C) that
+/// enables you to control each cache way independently.
+/// These registers enable you to control which cache ways of the four-way cache are used
+/// for the allocation on a linefill. When the registers are defined, subsequent linefills are
+/// only placed in the specified target cache way. This gives you some control over the
+/// cache pollution caused by particular applications, and provides a traditional lockdown
+/// operation for locking critical code into the cache.
+//------------------------------------------------------------------------------
+/// Read Dcache Lockdown Register   MRC p15,0,<Rd>,c9,c0,0
+/// Write Dcache Lockdown Register  MCR p15,0,<Rd>,c9,c0,0
+/// Read Icache Lockdown Register   MRC p15,0,<Rd>,c9,c0,1
+/// Write Icache Lockdown Register  MCR p15,0,<Rd>,c9,c0,1
+//------------------------------------------------------------------------------
+
+	.section .CP15_ReadDcacheLockdown
+	.global   CP15_ReadDcacheLockdown
+CP15_ReadDcacheLockdown:
+        mov     r0, #0
+        mrc     p15, 0, r0, c9, c0, 0
+        bx      lr
+
+	.section .CP15_WriteDcacheLockdown
+	.global   CP15_WriteDcacheLockdown
+CP15_WriteDcacheLockdown:
+        mcr     p15, 0, r0, c9, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+	.section .CP15_ReadIcacheLockdown
+	.global   CP15_ReadIcacheLockdown
+CP15_ReadIcacheLockdown:
+        mov     r0, #0
+        mrc     p15, 0, r0, c9, c0, 1
+        bx      lr
+
+	.section .CP15_WriteIcacheLockdown
+	.global   CP15_WriteIcacheLockdown
+CP15_WriteIcacheLockdown:
+        mcr     p15, 0, r0, c9, c0, 1
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// TLB Lockdown Register c10
+/// The TLB Lockdown Register controls where hardware page table walks place the
+/// TLB entry, in the set associative region or the lockdown region of the TLB,
+/// and if in the lockdown region, which entry is written. The lockdown region
+/// of the TLB contains eight entries. See TLB structure for a description of
+/// the structure of the TLB.
+//------------------------------------------------------------------------------
+/// Read data TLB lockdown victim    MRC p15,0,<Rd>,c10,c0,0
+/// Write data TLB lockdown victim   MCR p15,0,<Rd>,c10,c0,0
+//------------------------------------------------------------------------------
+	.section .CP15_ReadTLBLockdown
+	.global   CP15_ReadTLBLockdown
+CP15_ReadTLBLockdown:
+        mov     r0, #0
+        mrc     p15, 0, r0, c10, c0, 0
+        bx      lr
+
+	.section .CP15_WriteTLBLockdown
+	.global   CP15_WriteTLBLockdown
+CP15_WriteTLBLockdown:
+        mcr     p15, 0, r0, c10, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Register c13 accesses the process identifier registers. The register accessed depends on
+/// the value of the Opcode_2 field:
+/// Opcode_2 = 0  Selects the Fast Context Switch Extension (FCSE) Process Identifier (PID) Register.
+/// Opcode_2 = 1  Selects the Context ID Register.
+//------------------------------------------------------------------------------
+/// FCSE PID Register
+/// Addresses issued by the ARM9EJ-S core in the range 0 to 32MB are translated in
+/// accordance with the value contained in this register. Address A becomes A + (FCS
+/// PID x 32MB). It is this modified address that is seen by the caches, MMU, and TC
+/// interface. Addresses above 32MB are not modified. The FCSE PID is a seven-bit fie
+/// enabling 128 x 32MB processes to be mapped.
+/// If the FCSE PID is 0, there is a flat mapping between the virtual addresses output by
+/// ARM9EJ-S core and the modified virtual addresses used by the caches, MMU, and
+/// TCM interface. The FCSE PID is set to 0 at system reset.
+/// If the MMU is disabled, then no FCSE address translation occurs.
+/// FCSE translation is not applied for addresses used for entry based cache or TLB
+/// maintenance operations. For these operations VA = MVA.
+//------------------------------------------------------------------------------
+/// Read FCSE PID  MRC p15,0,<Rd>,c13,c0, 0
+/// Write FCSE PID MCR p15,0,<Rd>,c13,c0, 0
+//------------------------------------------------------------------------------
+/// Context ID Register
+/// The Context ID Register provides a mechanism to allow real-time trace tools to identify
+/// the currently executing process in multi-tasking environments.
+/// The contents of this register are replicated on the ETMPROCID pins of the
+/// ARM926EJ-S processor. ETMPROCIDWR is pulsed when a write occurs to the
+/// Context ID Register.
+//------------------------------------------------------------------------------
+/// Read context ID  MRC p15,0,<Rd>,c13,c0, 1
+/// Write context ID MCR p15,0,<Rd>,c13,c0, 1
+//------------------------------------------------------------------------------
+	.section .CP15_ReadFCSE_PID
+	.global   CP15_ReadFCSE_PID
+CP15_ReadFCSE_PID:
+        mov     r0, #0
+        mrc     p15, 0, r0, c13, c0, 0
+        bx      lr
+
+	.section .CP15_WriteFCSE_PID
+	.global   CP15_WriteFCSE_PID
+CP15_WriteFCSE_PID:
+        mcr     p15, 0, r0, c13, c0, 0
+        bx      lr
+#endif
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_iar.s b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_iar.s
new file mode 100644
index 0000000000000000000000000000000000000000..b18aff15e685b87436966f02380d10ed0010776f
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_iar.s
@@ -0,0 +1,659 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+        MODULE  ?cp15
+
+        ;; Forward declaration of sections.
+        SECTION IRQ_STACK:DATA:NOROOT(2)
+        SECTION CSTACK:DATA:NOROOT(3)
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#define __ASSEMBLY__
+#include "board.h"
+
+#ifdef CP15_PRESENT
+
+//------------------------------------------------------------------------------
+/// Functions to access CP15 coprocessor register
+//------------------------------------------------------------------------------
+        // c0
+        PUBLIC  CP15_ReadID
+        PUBLIC  CP15_ReaDcacheType
+        PUBLIC  CP15_ReadTCMStatus
+        // c1        
+        PUBLIC  CP15_ReadControl
+        PUBLIC  CP15_WriteControl
+        // c2        
+        PUBLIC  CP15_ReadTTB
+        PUBLIC  CP15_WriteTTB
+        // c3        
+        PUBLIC  CP15_ReadDomainAccessControl
+        PUBLIC  CP15_WriteDomainAccessControl
+        // c7        
+        PUBLIC  CP15_InvalidateIDcache
+        PUBLIC  CP15_InvalidateDcache
+        PUBLIC  CP15_InvalidateIcache
+        PUBLIC  CP15_PrefetchIcacheLine
+        PUBLIC  CP15_TestCleanInvalidateDcache
+        PUBLIC  CP15_DrainWriteBuffer
+        PUBLIC  CP15_WaitForInterrupt
+        // c8        
+        PUBLIC  CP15_InvalidateTLB
+        PUBLIC  CP15_InvalidateTLBMVA
+        PUBLIC  CP15_InvalidateITLB
+        PUBLIC  CP15_InvalidateITLBMVA
+        PUBLIC  CP15_InvalidateDTLB
+        PUBLIC  CP15_InvalidateDTLBMVA    
+        // c9        
+        PUBLIC  CP15_ReadDcacheLockdown
+        PUBLIC  CP15_WriteDcacheLockdown
+        PUBLIC  CP15_ReadIcacheLockdown 
+        PUBLIC  CP15_WriteIcacheLockdown
+        PUBLIC  CP15_ReadTLBLockdown
+        PUBLIC  CP15_WriteTLBLockdown 
+        // c13        
+        PUBLIC  CP15_ReadTLBLockdown
+        PUBLIC  CP15_WriteTLBLockdown        
+        // c13        
+        PUBLIC  CP15_ReadFCSE_PID
+        PUBLIC  CP15_WriteFCSE_PID
+
+//------------------------------------------------------------------------------
+/// c0
+/// Register c0 accesses the ID Register, Cache Type Register, and TCM Status Registers.
+/// Reading from this register returns the device ID, the cache type, or the TCM status
+/// depending on the value of Opcode_2 used:
+/// Opcode_2 = 0 ID value.
+/// Opcode_2 = 1 instruction and data cache type.
+/// Opcode_2 = 2 TCM status.
+//------------------------------------------------------------------------------
+        SECTION .CP15_ReadID:DATA:NOROOT(2)
+        PUBLIC   CP15_ReadID
+        //ARM
+// C0 read ID
+CP15_ReadID:
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 0
+        bx      lr
+
+        SECTION .CP15_ReaDcacheType:CODE:NOROOT(2)
+        PUBLIC   CP15_ReaDcacheType
+        //ARM
+// C0 read Cache Type
+CP15_ReaDcacheType:
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 1
+        bx      lr
+
+        SECTION .CP15_ReadTCMStatus:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadTCMStatus
+        //ARM
+// C0 read TCM status
+CP15_ReadTCMStatus:
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 2
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Control Register c1
+/// Register c1 is the Control Register for the ARM926EJ-S processor.
+/// This register specifies the configuration used to enable and disable the
+/// caches and MMU. It is recommended that you access this register using a
+/// read-modify-write sequence.
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_ReadControl:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadControl
+        //ARM
+// CP15 Read Control Register
+CP15_ReadControl:
+        mov     r0, #0
+        mrc     p15, 0, r0, c1, c0, 0   
+        bx      lr
+
+        SECTION .CP15_WriteControl:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteControl
+        //ARM
+// CP15 Write Control Register
+CP15_WriteControl:
+        mcr     p15, 0, r0, c1, c0, 0
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop        
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Translation Table Base Register c2
+/// Register c2 is the Translation Table Base Register (TTBR), for the base
+/// address of the first-level translation table.
+/// Reading from c2 returns the pointer to the currently active first-level
+/// translation table in bits [31:14] and an Unpredictable value in bits [13:0].
+/// Writing to register c2 updates the pointer to the first-level translation
+/// table from the value in bits [31:14] of the written value. Bits [13:0]
+/// Should Be Zero.
+/// You can use the following instructions to access the TTBR:
+/// Read TTBR  : MRC p15, 0, <Rd>, c2, c0, 0
+/// Write TTBR : MCR p15, 0, <Rd>, c2, c0, 0
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_ReadTTB:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadTTB
+        //ARM
+CP15_ReadTTB:
+        mov     r0, #0
+        mrc     p15, 0, r0, c2, c0, 0
+        bx      lr
+
+        SECTION .CP15_WriteTTB:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteTTB
+        //ARM
+CP15_WriteTTB:
+        mcr     p15, 0, r0, c2, c0, 0
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Domain Access Control Register c3
+/// Read domain access permissions  : MRC p15, 0, <Rd>, c3, c0, 0
+/// Write domain access permissions : MCR p15, 0, <Rd>, c3, c0, 0
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_ReadDomainAccessControl:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadDomainAccessControl
+        //ARM
+CP15_ReadDomainAccessControl:
+        mov     r0, #0
+        mrc     p15, 0, r0, c3, c0, 0
+        bx      lr
+
+        SECTION .CP15_WriteDomainAccessControl:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteDomainAccessControl
+        //ARM
+CP15_WriteDomainAccessControl:
+        mcr     p15, 0, r0, c3, c0, 0
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Fault Status Registers Register c5
+/// Register c5 accesses the Fault Status Registers (FSRs). The FSRs contain the source of
+/// the last instruction or data fault. The instruction-side FSR is intended for debug
+/// purposes only. The FSR is updated for alignment faults, and external aborts that occur
+/// while the MMU is disabled.
+/// The FSR accessed is determined by the value of the Opcode_2 field:
+/// Opcode_2 = 0  Data Fault Status Register (DFSR).
+/// Opcode_2 = 1  Instruction Fault Status Register (IFSR).
+/// The fault type encoding is listed in Table 3-9 on page 3-22.
+/// You can access the FSRs using the following instructions:
+/// MRC p15, 0, <Rd>, c5, c0, 0 ;read DFSR
+/// MCR p15, 0, <Rd>, c5, c0, 0 ;write DFSR
+/// MRC p15, 0, <Rd>, c5, c0, 1 ;read IFSR
+/// MCR p15, 0, <Rd>, c5, c0, 1 ;write IFSR
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_ReadDFSR:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadDFSR
+        //ARM
+CP15_ReadDFSR:
+        mov     r0, #0
+        mrc     p15, 0, r0, c5, c0, 0
+        bx      lr
+
+        SECTION .CP15_writeDFSR:CODE:NOROOT(2)
+        PUBLIC   CP15_writeDFSR
+        //ARM
+CP15_writeDFSR:
+        mcr     p15, 0, r0, c5, c0, 0
+        bx      lr
+
+        SECTION .CP15_ReadIFSR:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadIFSR
+        //ARM
+CP15_ReadIFSR:
+        mov     r0, #0
+        mrc     p15, 0, r0, c5, c0, 1
+        bx      lr
+
+        SECTION .CP15_WriteIFSR:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteIFSR
+        //ARM
+CP15_WriteIFSR:
+        mcr     p15, 0, r0, c5, c0, 1
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Fault Address Register c6
+/// Register c6 accesses the Fault Address Register (FAR). The FAR contains the Modified
+/// Virtual Address of the access being attempted when a Data Abort occurred. The FAR is
+/// only updated for Data Aborts, not for Prefetch Aborts. The FAR is updated for
+/// alignment faults, and external aborts that occur while the MMU is disabled.
+/// You can use the following instructions to access the FAR:
+/// MRC p15, 0, <Rd>, c6, c0, 0 ; read FAR
+/// MCR p15, 0, <Rd>, c6, c0, 0 ; write FAR
+//------------------------------------------------------------------------------
+        SECTION .CP15_ReadFAR:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadFAR
+        //ARM
+CP15_ReadFAR:
+        mov     r0, #0
+        mrc     p15, 0, r0, c6, c0, 0
+        bx      lr
+
+        SECTION .CP15_writeFAR:CODE:NOROOT(2)
+        PUBLIC   CP15_writeFAR
+        //ARM
+CP15_writeFAR:
+        mcr     p15, 0, r0, c6, c0, 0
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Control functions caches and the write buffer c7
+/// Register c7 controls the caches and the write buffer. The function of each cache
+/// operation is selected by the Opcode_2 and CRm fields in the MCR instruction used to
+/// write to CP15 c7. Writing other Opcode_2 or CRm values is Unpredictable.
+/// Reading from CP15 c7 is Unpredictable, with the exception of the two test and clean
+/// operations (see Table 2-18 on page 2-21 and Test and clean operations on page 2-23).
+/// You can use the following instruction to write to c7:
+/// MCR p15, <Opcode_1>, <Rd>, <CRn>, <CRm>, <Opcode_2>
+//------------------------------------------------------------------------------
+/// Invalidate Icache and Dcache                        MCR p15, 0, <Rd>, c7, c7, 0
+/// Invalidate Icache                                   MCR p15, 0, <Rd>, c7, c5, 0
+/// Invalidate Icache single entry (MVA) MVA            MCR p15, 0, <Rd>, c7, c5, 1
+/// Invalidate Icache single entry (Set/Way) Set/Way    MCR p15, 0, <Rd>, c7, c5, 2
+/// Prefetch Icache line (MVA) MVA                      MCR p15, 0, <Rd>, c7, c13, 1
+/// Invalidate Dcache                                   MCR p15, 0, <Rd>, c7, c6, 0
+/// Invalidate Dcache single entry (MVA) MVA            MCR p15, 0, <Rd>, c7, c6, 1
+/// Invalidate Dcache single entry (Set/Way) Set/Way    MCR p15, 0, <Rd>, c7, c6, 2
+/// Clean Dcache single entry (MVA) MVA                 MCR p15, 0, <Rd>, c7, c10, 1
+/// Clean Dcache single entry (Set/Way) Set/Way         MCR p15, 0, <Rd>, c7, c10, 2
+/// Test and clean Dcache -                             MRC p15, 0, <Rd>, c7, c10, 3
+/// Clean and invalidate Dcache entry (MVA)  MVA        MCR p15, 0, <Rd>, c7, c14, 1
+/// Clean and invalidate Dcache entry (Set/Way) Set/Way MCR p15, 0, <Rd>, c7, c14, 2
+/// Test, clean, and invalidate Dcache -                MRC p15, 0, <Rd>, c7, c14, 3
+/// Drain write buffer SBZ                              MCR p15, 0, <Rd>, c7, c10, 4
+/// Wait for interrupt SBZ                              MCR p15, 0, <Rd>, c7, c0, 4
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_InvalidateIDcache:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateIDcache
+        //ARM
+// Invalidate Icache and Dcache
+CP15_InvalidateIDcache:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c7, 0        
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop          
+        bx      lr
+        
+        SECTION .CP15_InvalidateIcache:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateIcache
+        //ARM
+// Invalidate Icache
+CP15_InvalidateIcache:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c5, 0     
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop          
+        bx      lr
+
+        SECTION .CP15_InvalidateDcache:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateDcache
+        //ARM
+// Invalidate Dcache
+CP15_InvalidateDcache:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c6, 0
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop          
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Prefetch Icache line c7
+/// Performs an Icache lookup of the specified modified virtual address.
+/// If the cache misses, and the region is cacheable, a linefill is performed.
+/// Prefetch Icache line (MVA): MCR p15, 0, <Rd>, c7, c13, 1
+//------------------------------------------------------------------------------
+        SECTION .CP15_PrefetchIcacheLine:CODE:NOROOT(2)
+        PUBLIC   CP15_PrefetchIcacheLine
+        //ARM
+CP15_PrefetchIcacheLine:
+        mcr     p15, 0, r0, c7, c13, 1
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Test, clean, and invalidate Dcache c7
+/// As for test and clean, except that when the entire cache has 
+/// been tested and cleaned, it is invalidated.
+//------------------------------------------------------------------------------
+        SECTION .CP15_TestCleanInvalidateDcache:CODE:NOROOT(2)
+        PUBLIC   CP15_TestCleanInvalidateDcache
+        //ARM
+CP15_TestCleanInvalidateDcache:
+        mrc     p15, 0, r0, c7, c14, 3
+        bne     CP15_TestCleanInvalidateDcache
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Drain write buffer c7
+/// This instruction acts as an explicit memory barrier. It drains 
+/// the contents of the write buffers of all memory stores 
+/// occurring in program order before this instruction is 
+/// completed. No instructions occurring in program order 
+/// after this instruction are executed until it completes. This 
+/// can be used when timing of specific stores to the level two 
+/// memory system has to be controlled (for example, when a 
+/// store to an interrupt acknowledge location has to complete 
+/// before interrupts are enabled).
+//------------------------------------------------------------------------------
+        SECTION .CP15_DrainWriteBuffer:CODE:NOROOT(2)
+        PUBLIC   CP15_DrainWriteBuffer
+        //ARM
+CP15_DrainWriteBuffer:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c10, 4
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// CP15 Wait For Interrupt operation c7
+/// The purpose of the Wait For Interrupt operation is to put the processor in
+/// to a low power state.
+/// This puts the processor into a low-power state and stops it executing more
+/// instructions until an interrupt, or debug request occurs, regardless of
+/// whether the interrupts are disabled by the masks in the CPSR.
+/// When an interrupt does occur, the mcr instruction completes and the IRQ or
+/// FIQ handler is entered as normal. The return link in r14_irq or r14_fiq
+/// contains the address of the mcr instruction plus 8, so that the normal
+/// instruction used for interrupt return (SUBS PC,R14,#4) returns to the
+/// instruction following the mcr.
+/// Wait For Interrupt : MCR p15, 0, <Rd>, c7, c0, 4
+//------------------------------------------------------------------------------
+        SECTION .CP15_WaitForInterrupt:CODE:NOROOT(2)
+        PUBLIC   CP15_WaitForInterrupt
+        //ARM
+CP15_WaitForInterrupt:
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c0, 4
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Translation Lookaside Buffer (TLB) : c8
+/// This is a write-only register used to control the Translation Lookaside Buffer (TLB).
+/// There is a single TLB used to hold entries for both data and instructions. The TLB is
+/// divided into two parts:
+/// • a set-associative part
+/// • a fully-associative part.
+/// The fully-associative part (also referred to as the lockdown part of the TLB) is used to
+/// store entries to be locked down. Entries held in the lockdown part of the TLB are
+/// preserved during an invalidate TLB operation. Entries can be removed from the
+/// lockdown TLB using an invalidate TLB single entry operation.
+/// Six TLB operations are defined, and the function to be performed is selected by the
+/// Opcode_2 and CRm fields in the MCR instruction used to write CP15 c8. Writing other
+/// Opcode_2 or CRm values is Unpredictable. Reading from this register is Unpredictable.
+//------------------------------------------------------------------------------
+/// Invalidate TLB                                 MCR p15, 0, <Rd>, c8, c7, 0
+/// Invalidate TLB single entry (MVA)              MCR p15, 0, <Rd>, c8, c7, 1
+/// Invalidate instruction TLB                     MCR p15, 0, <Rd>, c8, c5, 0
+/// Invalidate instruction TLB single entry (MVA)  MCR p15, 0, <Rd>, c8, c5, 1
+/// Invalidate data TLB                            MCR p15, 0, <Rd>, c8, c6, 0
+/// Invalidate data TLB single entry (MVA)         MCR p15, 0, <Rd>, c8, c6, 1
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_InvalidateTLB:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateTLB
+        //ARM
+CP15_InvalidateTLB:
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c7, 0
+        bx      lr
+
+        SECTION .CP15_InvalidateTLBMVA:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateTLBMVA
+        //ARM
+CP15_InvalidateTLBMVA:
+        mcr     p15, 0, r0, c8, c7, 1
+        bx      lr
+
+        SECTION .CP15_InvalidateITLB:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateITLB
+        //ARM
+CP15_InvalidateITLB:
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c5, 0
+        bx      lr
+
+        SECTION .CP15_InvalidateITLBMVA:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateITLBMVA
+        //ARM
+CP15_InvalidateITLBMVA:
+        mcr     p15, 0, r0, c8, c5, 1
+        bx      lr
+
+        SECTION .CP15_InvalidateDTLB:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateDTLB
+        //ARM
+CP15_InvalidateDTLB:
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c6, 0
+        bx      lr
+
+        SECTION .CP15_InvalidateDTLBMVA:CODE:NOROOT(2)
+        PUBLIC   CP15_InvalidateDTLBMVA
+        //ARM
+CP15_InvalidateDTLBMVA:
+        mcr     p15, 0, r0, c8, c6, 1
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Cache Lockdown Register c9
+/// The Cache Lockdown Register uses a cache-way-based locking scheme (Format C) that
+/// enables you to control each cache way independently.
+/// These registers enable you to control which cache ways of the four-way cache are used
+/// for the allocation on a linefill. When the registers are defined, subsequent linefills are
+/// only placed in the specified target cache way. This gives you some control over the
+/// cache pollution caused by particular applications, and provides a traditional lockdown
+/// operation for locking critical code into the cache.
+//------------------------------------------------------------------------------
+/// Read Dcache Lockdown Register   MRC p15,0,<Rd>,c9,c0,0
+/// Write Dcache Lockdown Register  MCR p15,0,<Rd>,c9,c0,0
+/// Read Icache Lockdown Register   MRC p15,0,<Rd>,c9,c0,1
+/// Write Icache Lockdown Register  MCR p15,0,<Rd>,c9,c0,1
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_ReadDcacheLockdown:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadDcacheLockdown
+        //ARM
+CP15_ReadDcacheLockdown:
+        mov     r0, #0
+        mrc     p15, 0, r0, c9, c0, 0
+        bx      lr
+
+        SECTION .CP15_WriteDcacheLockdown:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteDcacheLockdown
+        //ARM
+CP15_WriteDcacheLockdown:
+        mcr     p15, 0, r0, c9, c0, 0
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop          
+        bx      lr
+
+        SECTION .CP15_ReadIcacheLockdown:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadIcacheLockdown
+        //ARM
+CP15_ReadIcacheLockdown:
+        mov     r0, #0
+        mrc     p15, 0, r0, c9, c0, 1
+        bx      lr
+
+        SECTION .CP15_WriteIcacheLockdown:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteIcacheLockdown
+        //ARM
+CP15_WriteIcacheLockdown:
+        mcr     p15, 0, r0, c9, c0, 1
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop          
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// TLB Lockdown Register c10
+/// The TLB Lockdown Register controls where hardware page table walks place the
+/// TLB entry, in the set associative region or the lockdown region of the TLB,
+/// and if in the lockdown region, which entry is written. The lockdown region
+/// of the TLB contains eight entries. See TLB structure for a description of
+/// the structure of the TLB.
+//------------------------------------------------------------------------------
+/// Read data TLB lockdown victim    MRC p15,0,<Rd>,c10,c0,0
+/// Write data TLB lockdown victim   MCR p15,0,<Rd>,c10,c0,0
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_ReadTLBLockdown:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadTLBLockdown
+        //ARM
+CP15_ReadTLBLockdown:
+        mov     r0, #0
+        mrc     p15, 0, r0, c10, c0, 0
+        bx      lr
+
+        SECTION .CP15_WriteTLBLockdown:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteTLBLockdown
+        //ARM
+CP15_WriteTLBLockdown:
+        mcr     p15, 0, r0, c10, c0, 0
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+	nop
+        bx      lr
+
+//------------------------------------------------------------------------------
+/// Register c13 accesses the process identifier registers. The register accessed depends on
+/// the value of the Opcode_2 field:
+/// Opcode_2 = 0  Selects the Fast Context Switch Extension (FCSE) Process Identifier (PID) Register.
+/// Opcode_2 = 1  Selects the Context ID Register.
+//------------------------------------------------------------------------------
+/// FCSE PID Register
+/// Addresses issued by the ARM9EJ-S core in the range 0 to 32MB are translated in
+/// accordance with the value contained in this register. Address A becomes A + (FCS
+/// PID x 32MB). It is this modified address that is seen by the caches, MMU, and TC
+/// interface. Addresses above 32MB are not modified. The FCSE PID is a seven-bit fie
+/// enabling 128 x 32MB processes to be mapped.
+/// If the FCSE PID is 0, there is a flat mapping between the virtual addresses output by
+/// ARM9EJ-S core and the modified virtual addresses used by the caches, MMU, and
+/// TCM interface. The FCSE PID is set to 0 at system reset.
+/// If the MMU is disabled, then no FCSE address translation occurs.
+/// FCSE translation is not applied for addresses used for entry based cache or TLB
+/// maintenance operations. For these operations VA = MVA.
+//------------------------------------------------------------------------------
+/// Read FCSE PID  MRC p15,0,<Rd>,c13,c0, 0
+/// Write FCSE PID MCR p15,0,<Rd>,c13,c0, 0
+//------------------------------------------------------------------------------
+/// Context ID Register
+/// The Context ID Register provides a mechanism to allow real-time trace tools to identify
+/// the currently executing process in multi-tasking environments.
+/// The contents of this register are replicated on the ETMPROCID pins of the
+/// ARM926EJ-S processor. ETMPROCIDWR is pulsed when a write occurs to the
+/// Context ID Register.
+//------------------------------------------------------------------------------
+/// Read context ID  MRC p15,0,<Rd>,c13,c0, 1
+/// Write context ID MCR p15,0,<Rd>,c13,c0, 1
+//------------------------------------------------------------------------------
+
+        SECTION .CP15_ReadFCSE_PID:CODE:NOROOT(2)
+        PUBLIC   CP15_ReadFCSE_PID
+        //ARM
+CP15_ReadFCSE_PID:
+        mov     r0, #0
+        mrc     p15, 0, r0, c13, c0, 0
+        bx      lr
+
+        SECTION .CP15_WriteFCSE_PID:CODE:NOROOT(2)
+        PUBLIC   CP15_WriteFCSE_PID
+        //ARM
+CP15_WriteFCSE_PID:
+        mcr     p15, 0, r0, c13, c0, 0
+        bx      lr
+
+#endif
+    END
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_keil.s b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_keil.s
new file mode 100644
index 0000000000000000000000000000000000000000..700d96b9a9f95861993f0fadfe7bb9d1a2b5070e
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/cp15/cp15_asm_keil.s
@@ -0,0 +1,536 @@
+; ----------------------------------------------------------------------------
+;         ATMEL Microcontroller Software Support 
+; ----------------------------------------------------------------------------
+; Copyright (c) 2008, Atmel Corporation
+;
+; All rights reserved.
+;
+; Redistribution and use in source and binary forms, with or without
+; modification, are permitted provided that the following conditions are met:
+;
+; - Redistributions of source code must retain the above copyright notice,
+; this list of conditions and the disclaimer below.
+;
+; Atmel's name may not be used to endorse or promote products derived from
+; this software without specific prior written permission.
+;
+; DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+; IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+; MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+; DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+; INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+; LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+; OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+; LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+; NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+; EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+; ----------------------------------------------------------------------------
+;
+
+        AREA  cp15, CODE
+
+;------------------------------------------------------------------------------
+;         Headers
+;------------------------------------------------------------------------------
+
+;------------------------------------------------------------------------------
+; Functions to access CP15 coprocessor register
+;------------------------------------------------------------------------------
+        ; c0
+        EXPORT  CP15_ReadID
+        EXPORT  CP15_ReaDcacheType
+        EXPORT  CP15_ReadTCMStatus
+        ; c1        
+        EXPORT  CP15_ReadControl
+        EXPORT  CP15_WriteControl
+        ; c2        
+        EXPORT  CP15_ReadTTB
+        EXPORT  CP15_WriteTTB
+        ; c3        
+        EXPORT  CP15_ReadDomainAccessControl
+        EXPORT  CP15_WriteDomainAccessControl
+        ; c7        
+        EXPORT  CP15_InvalidateIDcache
+        EXPORT  CP15_InvalidateDcache
+        EXPORT  CP15_InvalidateIcache
+        EXPORT  CP15_PrefetchIcacheLine
+        EXPORT  CP15_TestCleanInvalidateDcache
+        EXPORT  CP15_DrainWriteBuffer
+        EXPORT  CP15_WaitForInterrupt
+        ; c8        
+        EXPORT  CP15_InvalidateTLB
+        EXPORT  CP15_InvalidateTLBMVA
+        EXPORT  CP15_InvalidateITLB
+        EXPORT  CP15_InvalidateITLBMVA
+        EXPORT  CP15_InvalidateDTLB
+        EXPORT  CP15_InvalidateDTLBMVA    
+        ; c9        
+        EXPORT  CP15_ReadDcacheLockdown
+        EXPORT  CP15_WriteDcacheLockdown
+        EXPORT  CP15_ReadIcacheLockdown 
+        EXPORT  CP15_WriteIcacheLockdown
+        EXPORT  CP15_ReadTLBLockdown
+        EXPORT  CP15_WriteTLBLockdown 
+        ; c13        
+        EXPORT  CP15_ReadTLBLockdown
+        EXPORT  CP15_WriteTLBLockdown        
+        ; c13        
+        EXPORT  CP15_ReadFCSE_PID
+        EXPORT  CP15_WriteFCSE_PID
+
+;------------------------------------------------------------------------------
+; c0
+; Register c0 accesses the ID Register, Cache Type Register, and TCM Status Registers.
+; Reading from this register returns the device ID, the cache type, or the TCM status
+; depending on the value of Opcode_2 used:
+; Opcode_2 = 0 ID value.
+; Opcode_2 = 1 instruction and data cache type.
+; Opcode_2 = 2 TCM status.
+;------------------------------------------------------------------------------
+
+; C0 read ID
+CP15_ReadID
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 0
+        bx      lr
+
+; C0 read Cache Type
+CP15_ReaDcacheType
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 1
+        bx      lr
+
+; C0 read TCM status
+CP15_ReadTCMStatus
+        mov     r0, #0
+        mrc     p15, 0, r0, c0, c0, 2
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Control Register c1
+; Register c1 is the Control Register for the ARM926EJ-S processor.
+; This register specifies the configuration used to enable and disable the
+; caches and MMU. It is recommended that you access this register using a
+; read-modify-write sequence.
+;------------------------------------------------------------------------------
+; CP15 Read Control Register
+CP15_ReadControl
+        mov     r0, #0
+        mrc     p15, 0, r0, c1, c0, 0   
+        bx      lr
+
+; CP15 Write Control Register
+CP15_WriteControl
+        mcr     p15, 0, r0, c1, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop        
+        bx      lr
+
+;------------------------------------------------------------------------------
+; CP15 Translation Table Base Register c2
+; Register c2 is the Translation Table Base Register (TTBR), for the base
+; address of the first-level translation table.
+; Reading from c2 returns the pointer to the currently active first-level
+; translation table in bits [31:14] and an Unpredictable value in bits [13:0].
+; Writing to register c2 updates the pointer to the first-level translation
+; table from the value in bits [31:14] of the written value. Bits [13:0]
+; Should Be Zero.
+; You can use the following instructions to access the TTBR:
+; Read TTBR  : MRC p15, 0, <Rd>, c2, c0, 0
+; Write TTBR : MCR p15, 0, <Rd>, c2, c0, 0
+;------------------------------------------------------------------------------
+CP15_ReadTTB
+        mov     r0, #0
+        mrc     p15, 0, r0, c2, c0, 0
+        bx      lr
+
+CP15_WriteTTB
+        mcr     p15, 0, r0, c2, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Domain Access Control Register c3
+; Read domain access permissions  : MRC p15, 0, <Rd>, c3, c0, 0
+; Write domain access permissions : MCR p15, 0, <Rd>, c3, c0, 0
+;------------------------------------------------------------------------------
+CP15_ReadDomainAccessControl
+        mov     r0, #0
+        mrc     p15, 0, r0, c3, c0, 0
+        bx      lr
+
+CP15_WriteDomainAccessControl
+        mcr     p15, 0, r0, c3, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Fault Status Registers Register c5
+; Register c5 accesses the Fault Status Registers (FSRs). The FSRs contain the source of
+; the last instruction or data fault. The instruction-side FSR is intended for debug
+; purposes only. The FSR is updated for alignment faults, and external aborts that occur
+; while the MMU is disabled.
+; The FSR accessed is determined by the value of the Opcode_2 field:
+; Opcode_2 = 0  Data Fault Status Register (DFSR).
+; Opcode_2 = 1  Instruction Fault Status Register (IFSR).
+; The fault type encoding is listed in Table 3-9 on page 3-22.
+; You can access the FSRs using the following instructions:
+; MRC p15, 0, <Rd>, c5, c0, 0 ;read DFSR
+; MCR p15, 0, <Rd>, c5, c0, 0 ;write DFSR
+; MRC p15, 0, <Rd>, c5, c0, 1 ;read IFSR
+; MCR p15, 0, <Rd>, c5, c0, 1 ;write IFSR
+;------------------------------------------------------------------------------
+
+CP15_ReadDFSR
+        mov     r0, #0
+        mrc     p15, 0, r0, c5, c0, 0
+        bx      lr
+
+CP15_writeDFSR
+        mcr     p15, 0, r0, c5, c0, 0
+        bx      lr
+
+CP15_ReadIFSR
+        mov     r0, #0
+        mrc     p15, 0, r0, c5, c0, 1
+        bx      lr
+
+CP15_WriteIFSR
+        mcr     p15, 0, r0, c5, c0, 1
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Fault Address Register c6
+; Register c6 accesses the Fault Address Register (FAR). The FAR contains the Modified
+; Virtual Address of the access being attempted when a Data Abort occurred. The FAR is
+; only updated for Data Aborts, not for Prefetch Aborts. The FAR is updated for
+; alignment faults, and external aborts that occur while the MMU is disabled.
+; You can use the following instructions to access the FAR:
+; MRC p15, 0, <Rd>, c6, c0, 0 ; read FAR
+; MCR p15, 0, <Rd>, c6, c0, 0 ; write FAR
+;------------------------------------------------------------------------------
+CP15_ReadFAR
+        mov     r0, #0
+        mrc     p15, 0, r0, c6, c0, 0
+        bx      lr
+
+CP15_writeFAR
+        mcr     p15, 0, r0, c6, c0, 0
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Control functions caches and the write buffer c7
+; Register c7 controls the caches and the write buffer. The function of each cache
+; operation is selected by the Opcode_2 and CRm fields in the MCR instruction used to
+; write to CP15 c7. Writing other Opcode_2 or CRm values is Unpredictable.
+; Reading from CP15 c7 is Unpredictable, with the exception of the two test and clean
+; operations (see Table 2-18 on page 2-21 and Test and clean operations on page 2-23).
+; You can use the following instruction to write to c7:
+; MCR p15, <Opcode_1>, <Rd>, <CRn>, <CRm>, <Opcode_2>
+;------------------------------------------------------------------------------
+; Invalidate Icache and Dcache                        MCR p15, 0, <Rd>, c7, c7, 0
+; Invalidate Icache                                   MCR p15, 0, <Rd>, c7, c5, 0
+; Invalidate Icache single entry (MVA) MVA            MCR p15, 0, <Rd>, c7, c5, 1
+; Invalidate Icache single entry (Set/Way) Set/Way    MCR p15, 0, <Rd>, c7, c5, 2
+; Prefetch Icache line (MVA) MVA                      MCR p15, 0, <Rd>, c7, c13, 1
+; Invalidate Dcache                                   MCR p15, 0, <Rd>, c7, c6, 0
+; Invalidate Dcache single entry (MVA) MVA            MCR p15, 0, <Rd>, c7, c6, 1
+; Invalidate Dcache single entry (Set/Way) Set/Way    MCR p15, 0, <Rd>, c7, c6, 2
+; Clean Dcache single entry (MVA) MVA                 MCR p15, 0, <Rd>, c7, c10, 1
+; Clean Dcache single entry (Set/Way) Set/Way         MCR p15, 0, <Rd>, c7, c10, 2
+; Test and clean Dcache -                             MRC p15, 0, <Rd>, c7, c10, 3
+; Clean and invalidate Dcache entry (MVA)  MVA        MCR p15, 0, <Rd>, c7, c14, 1
+; Clean and invalidate Dcache entry (Set/Way) Set/Way MCR p15, 0, <Rd>, c7, c14, 2
+; Test, clean, and invalidate Dcache -                MRC p15, 0, <Rd>, c7, c14, 3
+; Drain write buffer SBZ                              MCR p15, 0, <Rd>, c7, c10, 4
+; Wait for interrupt SBZ                              MCR p15, 0, <Rd>, c7, c0, 4
+;------------------------------------------------------------------------------
+
+; Invalidate Icache and Dcache
+CP15_InvalidateIDcache
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c7, 0        
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+        
+; Invalidate Icache
+CP15_InvalidateIcache
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c5, 0     
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+; Invalidate Dcache
+CP15_InvalidateDcache
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c6, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+;------------------------------------------------------------------------------
+; CP15 Prefetch Icache line c7
+; Performs an Icache lookup of the specified modified virtual address.
+; If the cache misses, and the region is cacheable, a linefill is performed.
+; Prefetch Icache line (MVA): MCR p15, 0, <Rd>, c7, c13, 1
+;------------------------------------------------------------------------------
+CP15_PrefetchIcacheLine
+        mcr     p15, 0, r0, c7, c13, 1
+        bx      lr
+
+;------------------------------------------------------------------------------
+; CP15 Test, clean, and invalidate Dcache c7
+; As for test and clean, except that when the entire cache has 
+; been tested and cleaned, it is invalidated.
+;------------------------------------------------------------------------------
+CP15_TestCleanInvalidateDcache
+        mrc     p15, 0, r0, c7, c14, 3
+        bne     CP15_TestCleanInvalidateDcache
+        bx      lr
+
+;------------------------------------------------------------------------------
+; CP15 Drain write buffer c7
+; This instruction acts as an explicit memory barrier. It drains 
+; the contents of the write buffers of all memory stores 
+; occurring in program order before this instruction is 
+; completed. No instructions occurring in program order 
+; after this instruction are executed until it completes. This 
+; can be used when timing of specific stores to the level two 
+; memory system has to be controlled (for example, when a 
+; store to an interrupt acknowledge location has to complete 
+; before interrupts are enabled).
+;------------------------------------------------------------------------------
+CP15_DrainWriteBuffer
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c10, 4
+        bx      lr
+
+;------------------------------------------------------------------------------
+; CP15 Wait For Interrupt operation c7
+; The purpose of the Wait For Interrupt operation is to put the processor in
+; to a low power state.
+; This puts the processor into a low-power state and stops it executing more
+; instructions until an interrupt, or debug request occurs, regardless of
+; whether the interrupts are disabled by the masks in the CPSR.
+; When an interrupt does occur, the mcr instruction completes and the IRQ or
+; FIQ handler is entered as normal. The return link in r14_irq or r14_fiq
+; contains the address of the mcr instruction plus 8, so that the normal
+; instruction used for interrupt return (SUBS PC,R14,#4) returns to the
+; instruction following the mcr.
+; Wait For Interrupt : MCR p15, 0, <Rd>, c7, c0, 4
+;------------------------------------------------------------------------------
+CP15_WaitForInterrupt
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c0, 4
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Translation Lookaside Buffer (TLB) : c8
+; This is a write-only register used to control the Translation Lookaside Buffer (TLB).
+; There is a single TLB used to hold entries for both data and instructions. The TLB is
+; divided into two parts:
+; • a set-associative part
+; • a fully-associative part.
+; The fully-associative part (also referred to as the lockdown part of the TLB) is used to
+; store entries to be locked down. Entries held in the lockdown part of the TLB are
+; preserved during an invalidate TLB operation. Entries can be removed from the
+; lockdown TLB using an invalidate TLB single entry operation.
+; Six TLB operations are defined, and the function to be performed is selected by the
+; Opcode_2 and CRm fields in the MCR instruction used to write CP15 c8. Writing other
+; Opcode_2 or CRm values is Unpredictable. Reading from this register is Unpredictable.
+;------------------------------------------------------------------------------
+; Invalidate TLB                                 MCR p15, 0, <Rd>, c8, c7, 0
+; Invalidate TLB single entry (MVA)              MCR p15, 0, <Rd>, c8, c7, 1
+; Invalidate instruction TLB                     MCR p15, 0, <Rd>, c8, c5, 0
+; Invalidate instruction TLB single entry (MVA)  MCR p15, 0, <Rd>, c8, c5, 1
+; Invalidate data TLB                            MCR p15, 0, <Rd>, c8, c6, 0
+; Invalidate data TLB single entry (MVA)         MCR p15, 0, <Rd>, c8, c6, 1
+;------------------------------------------------------------------------------
+
+CP15_InvalidateTLB
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c7, 0
+        bx      lr
+
+CP15_InvalidateTLBMVA
+        mcr     p15, 0, r0, c8, c7, 1
+        bx      lr
+
+CP15_InvalidateITLB
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c5, 0
+        bx      lr
+
+CP15_InvalidateITLBMVA
+        mcr     p15, 0, r0, c8, c5, 1
+        bx      lr
+
+CP15_InvalidateDTLB
+        mov     r0, #0
+        mcr     p15, 0, r0, c8, c6, 0
+        bx      lr
+
+CP15_InvalidateDTLBMVA
+        mcr     p15, 0, r0, c8, c6, 1
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Cache Lockdown Register c9
+; The Cache Lockdown Register uses a cache-way-based locking scheme (Format C) that
+; enables you to control each cache way independently.
+; These registers enable you to control which cache ways of the four-way cache are used
+; for the allocation on a linefill. When the registers are defined, subsequent linefills are
+; only placed in the specified target cache way. This gives you some control over the
+; cache pollution caused by particular applications, and provides a traditional lockdown
+; operation for locking critical code into the cache.
+;------------------------------------------------------------------------------
+; Read Dcache Lockdown Register   MRC p15,0,<Rd>,c9,c0,0
+; Write Dcache Lockdown Register  MCR p15,0,<Rd>,c9,c0,0
+; Read Icache Lockdown Register   MRC p15,0,<Rd>,c9,c0,1
+; Write Icache Lockdown Register  MCR p15,0,<Rd>,c9,c0,1
+;------------------------------------------------------------------------------
+
+CP15_ReadDcacheLockdown
+        mov     r0, #0
+        mrc     p15, 0, r0, c9, c0, 0
+        bx      lr
+
+CP15_WriteDcacheLockdown
+        mcr     p15, 0, r0, c9, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+CP15_ReadIcacheLockdown
+        mov     r0, #0
+        mrc     p15, 0, r0, c9, c0, 1
+        bx      lr
+
+CP15_WriteIcacheLockdown
+        mcr     p15, 0, r0, c9, c0, 1
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop          
+        bx      lr
+
+;------------------------------------------------------------------------------
+; TLB Lockdown Register c10
+; The TLB Lockdown Register controls where hardware page table walks place the
+; TLB entry, in the set associative region or the lockdown region of the TLB,
+; and if in the lockdown region, which entry is written. The lockdown region
+; of the TLB contains eight entries. See TLB structure for a description of
+; the structure of the TLB.
+;------------------------------------------------------------------------------
+; Read data TLB lockdown victim    MRC p15,0,<Rd>,c10,c0,0
+; Write data TLB lockdown victim   MCR p15,0,<Rd>,c10,c0,0
+;------------------------------------------------------------------------------
+CP15_ReadTLBLockdown
+        mov     r0, #0
+        mrc     p15, 0, r0, c10, c0, 0
+        bx      lr
+
+CP15_WriteTLBLockdown
+        mcr     p15, 0, r0, c10, c0, 0
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        nop
+        bx      lr
+
+;------------------------------------------------------------------------------
+; Register c13 accesses the process identifier registers. The register accessed depends on
+; the value of the Opcode_2 field:
+; Opcode_2 = 0  Selects the Fast Context Switch Extension (FCSE) Process Identifier (PID) Register.
+; Opcode_2 = 1  Selects the Context ID Register.
+;------------------------------------------------------------------------------
+; FCSE PID Register
+; Addresses issued by the ARM9EJ-S core in the range 0 to 32MB are translated in
+; accordance with the value contained in this register. Address A becomes A + (FCS
+; PID x 32MB). It is this modified address that is seen by the caches, MMU, and TC
+; interface. Addresses above 32MB are not modified. The FCSE PID is a seven-bit fie
+; enabling 128 x 32MB processes to be mapped.
+; If the FCSE PID is 0, there is a flat mapping between the virtual addresses output by
+; ARM9EJ-S core and the modified virtual addresses used by the caches, MMU, and
+; TCM interface. The FCSE PID is set to 0 at system reset.
+; If the MMU is disabled, then no FCSE address translation occurs.
+; FCSE translation is not applied for addresses used for entry based cache or TLB
+; maintenance operations. For these operations VA = MVA.
+;------------------------------------------------------------------------------
+; Read FCSE PID  MRC p15,0,<Rd>,c13,c0, 0
+; Write FCSE PID MCR p15,0,<Rd>,c13,c0, 0
+;------------------------------------------------------------------------------
+; Context ID Register
+; The Context ID Register provides a mechanism to allow real-time trace tools to identify
+; the currently executing process in multi-tasking environments.
+; The contents of this register are replicated on the ETMPROCID pins of the
+; ARM926EJ-S processor. ETMPROCIDWR is pulsed when a write occurs to the
+; Context ID Register.
+;------------------------------------------------------------------------------
+; Read context ID  MRC p15,0,<Rd>,c13,c0, 1
+; Write context ID MCR p15,0,<Rd>,c13,c0, 1
+;------------------------------------------------------------------------------
+CP15_ReadFCSE_PID
+        mov     r0, #0
+        mrc     p15, 0, r0, c13, c0, 0
+        bx      lr
+
+CP15_WriteFCSE_PID
+        mcr     p15, 0, r0, c13, c0, 0
+        bx      lr
+    END
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.c b/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.c
new file mode 100644
index 0000000000000000000000000000000000000000..0b3b380c3714235c48b270eeddcde0d107ee433a
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.c
@@ -0,0 +1,114 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "dbgu.h"
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+/// Initializes the DBGU with the given parameters, and enables both the
+/// transmitter and the receiver. The mode parameter contains the value of the
+/// DBGU_MR register.
+/// Value DBGU_STANDARD can be used for mode to get the most common configuration
+/// (i.e. aysnchronous, 8bits, no parity, 1 stop bit, no flow control).
+/// \param mode  Operating mode to configure.
+/// \param baudrate  Desired baudrate (e.g. 115200).
+/// \param mck  Frequency of the system master clock in Hz.
+//------------------------------------------------------------------------------
+void DBGU_Configure(
+    unsigned int mode,
+    unsigned int baudrate,
+    unsigned int mck)
+{
+    #if defined(cortexm3)
+    // Enable clock for UART
+    AT91C_BASE_PMC->PMC_PCER = (1 << AT91C_ID_DBGU);
+    #endif
+
+    // Reset & disable receiver and transmitter, disable interrupts
+    AT91C_BASE_DBGU->DBGU_CR = AT91C_US_RSTRX | AT91C_US_RSTTX;
+    AT91C_BASE_DBGU->DBGU_IDR = 0xFFFFFFFF;
+    
+    // Configure baud rate
+    AT91C_BASE_DBGU->DBGU_BRGR = mck / (baudrate * 16);
+    
+    // Configure mode register
+    AT91C_BASE_DBGU->DBGU_MR = mode;
+    
+    // Disable DMA channel
+    AT91C_BASE_DBGU->DBGU_PTCR = AT91C_PDC_RXTDIS | AT91C_PDC_TXTDIS;
+
+    // Enable receiver and transmitter
+    AT91C_BASE_DBGU->DBGU_CR = AT91C_US_RXEN | AT91C_US_TXEN;
+}
+
+//------------------------------------------------------------------------------
+/// Outputs a character on the DBGU line.
+/// \note This function is synchronous (i.e. uses polling).
+/// \param c  Character to send.
+//------------------------------------------------------------------------------
+void DBGU_PutChar(unsigned char c)
+{
+    // Wait for the transmitter to be ready
+    while ((AT91C_BASE_DBGU->DBGU_CSR & AT91C_US_TXEMPTY) == 0);
+    
+    // Send character
+    AT91C_BASE_DBGU->DBGU_THR = c;
+    
+    // Wait for the transfer to complete
+    while ((AT91C_BASE_DBGU->DBGU_CSR & AT91C_US_TXEMPTY) == 0);
+}
+
+//------------------------------------------------------------------------------
+/// Return 1 if a character can be read in DBGU
+//------------------------------------------------------------------------------
+unsigned int DBGU_IsRxReady()
+{
+    return (AT91C_BASE_DBGU->DBGU_CSR & AT91C_US_RXRDY);
+}
+
+//------------------------------------------------------------------------------
+/// Reads and returns a character from the DBGU.
+/// \note This function is synchronous (i.e. uses polling).
+/// \return Character received.
+//------------------------------------------------------------------------------
+unsigned char DBGU_GetChar(void)
+{
+    while ((AT91C_BASE_DBGU->DBGU_CSR & AT91C_US_RXRDY) == 0);
+    return AT91C_BASE_DBGU->DBGU_RHR;
+}
+
+
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.dir b/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.dir
new file mode 100644
index 0000000000000000000000000000000000000000..ec31900352402ac0ef94b2e3f98d26684554bd6c
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.dir
@@ -0,0 +1,37 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+///
+/// Contains the peripheral API for the Debug Unit (DBGU).
+//------------------------------------------------------------------------------
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.h b/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.h
new file mode 100644
index 0000000000000000000000000000000000000000..816f11dcfe3c93f7f0e3909dc10d92b052504885
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/dbgu/dbgu.h
@@ -0,0 +1,79 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+/// 
+/// This module provides definitions and functions for using the Debug Unit
+/// (DBGU).
+///
+/// It also overloads the fputc(), fputs() & putchar() functions so the printf()
+/// method outputs its data on the DBGU. This behavior can be suppressed by
+/// defining NOFPUT during compilation.
+///
+/// !Usage
+/// 
+/// -# Enable the DBGU pins (see pio & board.h).
+/// -# Configure the DBGU using DBGU_Configure with the desired operating mode.
+/// -# Send characters using DBGU_PutChar() or the printf() method.
+/// -# Receive characters using DBGU_GetChar().
+///
+/// \note Unless specified, all the functions defined here operate synchronously;
+/// i.e. they all wait the data is sent/received before returning.
+//------------------------------------------------------------------------------
+
+#ifndef DBGU_H
+#define DBGU_H
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+ 
+/// Standard operating mode (asynchronous, 8bit, no parity, 1 stop bit)
+#define DBGU_STANDARD           AT91C_US_PAR_NONE
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+extern void DBGU_Configure(
+    unsigned int mode,
+    unsigned int baudrate,
+    unsigned int mck);
+
+extern unsigned char DBGU_GetChar(void);
+
+extern void DBGU_PutChar(unsigned char c);
+
+extern unsigned int DBGU_IsRxReady(void);
+
+#endif //#ifndef DBGU_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/irq/aic.c b/usb-loader/samba_applets/at91lib/peripherals/irq/aic.c
new file mode 100644
index 0000000000000000000000000000000000000000..d2353f584e7de603b66fe49494247115ba87d497
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/irq/aic.c
@@ -0,0 +1,91 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+#include "irq.h"
+
+#ifndef AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL
+    /// Interrupt is internal and uses a logical 1 level.
+    #define AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE
+#endif
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Configures an interrupt in the AIC. The interrupt is identified by its
+/// source (AT91C_ID_xxx) and is configured to use the specified mode and
+/// interrupt handler function. Mode is the value that will be put in AIC_SMRx
+/// and the function address will be set in AIC_SVRx.
+/// The interrupt is disabled before configuration, so it is useless
+/// to do it before calling this function. When AIC_ConfigureIT returns, the
+/// interrupt will always be disabled and cleared; it must be enabled by a
+/// call to AIC_EnableIT().
+/// \param source  Interrupt source to configure.
+/// \param mode  Triggering mode and priority of the interrupt.
+/// \param handler  Interrupt handler function.
+//------------------------------------------------------------------------------
+void IRQ_ConfigureIT(unsigned int source,
+                     unsigned int mode,
+                     void( *handler )( void ))
+{
+    // Disable the interrupt first
+    AT91C_BASE_AIC->AIC_IDCR = 1 << source;
+
+    // Configure mode and handler
+    AT91C_BASE_AIC->AIC_SMR[source] = mode;
+    AT91C_BASE_AIC->AIC_SVR[source] = (unsigned int) handler;
+
+    // Clear interrupt
+    AT91C_BASE_AIC->AIC_ICCR = 1 << source;
+}
+
+//------------------------------------------------------------------------------
+/// Enables interrupts coming from the given (unique) source (AT91C_ID_xxx).
+/// \param source  Interrupt source to enable.
+//------------------------------------------------------------------------------
+void IRQ_EnableIT(unsigned int source)
+{
+    AT91C_BASE_AIC->AIC_IECR = 1 << source;
+}
+
+//------------------------------------------------------------------------------
+/// Disables interrupts coming from the given (unique) source (AT91C_ID_xxx).
+/// \param source  Interrupt source to enable.
+//------------------------------------------------------------------------------
+void IRQ_DisableIT(unsigned int source)
+{
+    AT91C_BASE_AIC->AIC_IDCR = 1 << source;
+}
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/irq/irq.dir b/usb-loader/samba_applets/at91lib/peripherals/irq/irq.dir
new file mode 100644
index 0000000000000000000000000000000000000000..06e017a41a32b37fc1a299ad3167972e1632eb15
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/irq/irq.dir
@@ -0,0 +1,38 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+///
+/// This directory contains an API for Configure the Interrupt controller.
+/// The interrupt controller for SAM7 and SAM9 is AIC, and the interrupt controller
+/// for SAM3 is NVIC.
+//------------------------------------------------------------------------------
\ No newline at end of file
diff --git a/usb-loader/samba_applets/at91lib/peripherals/irq/irq.h b/usb-loader/samba_applets/at91lib/peripherals/irq/irq.h
new file mode 100644
index 0000000000000000000000000000000000000000..7748e4bad17a931b5b724dcb9baffd06b4aabad1
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/irq/irq.h
@@ -0,0 +1,84 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+/// 
+/// Methods and definitions for configuring interrupts.
+/// 
+/// !Usage
+///
+/// -# Configure an interrupt source using IRQ_ConfigureIT
+/// -# Enable or disable interrupt generation of a particular source with
+///    IRQ_EnableIT and IRQ_DisableIT.
+///
+/// \note Most of the time, peripheral interrupts must be also configured
+/// inside the peripheral itself.
+//------------------------------------------------------------------------------
+
+#ifndef IRQ_H
+#define IRQ_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+#if defined(cortexm3)
+#include <cmsis/core_cm3.h>
+#endif
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+#if 0
+#if defined(cortexm3)
+#ifdef __NVIC_PRIO_BITS
+#undef __NVIC_PRIO_BITS
+#define __NVIC_PRIO_BITS           ((SCB->AIRCR & 0x700) >> 8) 
+#endif
+#endif
+#endif
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+extern void IRQ_ConfigureIT(unsigned int source,
+                            unsigned int mode,         // mode for AIC, priority for NVIC
+                            void( *handler )( void )); // ISR
+
+extern void IRQ_EnableIT(unsigned int source);
+
+extern void IRQ_DisableIT(unsigned int source);
+
+#endif //#ifndef IRQ_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/irq/nvic.c b/usb-loader/samba_applets/at91lib/peripherals/irq/nvic.c
new file mode 100644
index 0000000000000000000000000000000000000000..b7d40b297d163b52dad62929f9c076d540bc12e3
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/irq/nvic.c
@@ -0,0 +1,144 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "board.h"
+#include "irq.h"
+#include "exceptions.h"
+#include <utility/trace.h>
+
+/// The index of IRQ handler in the exception table
+#define NVIC_IRQ_HANDLER_INDEX     16
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Configures an interrupt in the NVIC. The interrupt is identified by its
+/// source (AT91C_ID_xxx) and is configured to a specified priority and
+/// interrupt handler function. priority is the value that will be put in NVIC_IPRx
+/// and the function address will be set in "ExceptionTable". The parameter priority
+/// will include the preemptionPriority and the subPriority, where the subPriority
+/// defined in the B[7:0] of the parameter "priority", and the preemptionPriority defined
+/// in the B[15:8] of the parameter "priority". 
+/// The interrupt is disabled before configuration, so it is useless
+/// to do it before calling this function. When NVIC_ConfigureIT returns, the
+/// interrupt will always be disabled and cleared; it must be enabled by a
+/// call to NVIC_EnableIT().
+/// \param source               Interrupt source to configure.
+/// \param priority              Pre-emption priority (B[15:8] )+ subPriority (B[7:0])
+/// \param handler              Interrupt handler function.
+//------------------------------------------------------------------------------
+void IRQ_ConfigureIT(
+    unsigned int source,
+    //unsigned int preemptionPriority,
+    //unsigned int subPriority,
+    unsigned int priority,
+    IntFunc handler)
+{
+    unsigned int priGroup = __NVIC_PRIO_BITS;
+    unsigned int nPre = 8 - priGroup;
+    unsigned int nSub = priGroup;
+    unsigned int preemptionPriority;
+    unsigned int subPriority;
+    unsigned int IRQpriority;
+
+    preemptionPriority = (priority & 0xff00) >> 8;
+    subPriority = (priority & 0xff);
+
+    // Disable the interrupt first
+    NVIC_DisableIRQ((IRQn_Type)source);
+
+    // Clear any pending status
+    NVIC_ClearPendingIRQ((IRQn_Type)source);
+
+    // Configure interrupt handler
+    //if (handler == 0) handler = IrqHandlerNotUsed;
+      //  GetExceptionTable()[NVIC_IRQ_HANDLER_INDEX + source] = handler;
+
+    if (subPriority >= (0x01 << nSub))
+      subPriority = (0x01 << nSub) - 1;
+    if (preemptionPriority >= (0x01 << nPre))
+      preemptionPriority = (0x01 << nPre) - 1;
+
+    IRQpriority = (subPriority | (preemptionPriority << nSub));
+    NVIC_SetPriority((IRQn_Type)source, IRQpriority);
+}
+
+//------------------------------------------------------------------------------
+/// Enables interrupt coming from the given (unique) source (AT91C_ID_xxx).
+/// \param source  Interrupt source to enable.
+//------------------------------------------------------------------------------
+void IRQ_EnableIT(unsigned int source)
+{
+    NVIC_EnableIRQ((IRQn_Type)source);
+}
+
+//------------------------------------------------------------------------------
+/// Disables interrupt coming from the given (unique) source (AT91C_ID_xxx).
+/// \param source  Interrupt source to disable.
+//------------------------------------------------------------------------------
+void IRQ_DisableIT(unsigned int source)
+{
+    NVIC_DisableIRQ((IRQn_Type)source);
+}
+
+//------------------------------------------------------------------------------
+/// Set interrupt pending bit from the given (unique) source (AT91C_ID_xxx).
+/// \param source  Interrupt source to set.
+//------------------------------------------------------------------------------
+void NVIC_SetPending(unsigned int source)
+{
+    NVIC_SetPendingIRQ((IRQn_Type)source);
+}
+
+//------------------------------------------------------------------------------
+/// Clear interrupt pending bit from the given (unique) source (AT91C_ID_xxx).
+/// \param source  Interrupt source to clear.
+//------------------------------------------------------------------------------
+void NVIC_ClrPending(unsigned int source)
+{
+    NVIC_ClearPendingIRQ((IRQn_Type)source);
+}
+
+#if !defined(USE_CMSIS_on)
+//------------------------------------------------------------------------------
+/// Use the Software Trigger Interrupt Register to pend an interrupt.
+/// \param source Interrupt source to trigger.
+//------------------------------------------------------------------------------
+void NVIC_Swi(unsigned int source)
+{
+    AT91C_BASE_NVIC->NVIC_STIR = source;
+}
+#endif
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/irq/nvic.h b/usb-loader/samba_applets/at91lib/peripherals/irq/nvic.h
new file mode 100644
index 0000000000000000000000000000000000000000..ff33ab0bba6f930d44b3921b3ab2ccbe258ddf41
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/irq/nvic.h
@@ -0,0 +1,55 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+/// 
+/// Methods and definitions for configuring interrupts using the Nested
+/// Vectored Interrupt Controller (NVIC).
+/// 
+/// !Usage
+///
+/// -# Configure interrupt source by implementing specific functions and define
+///    ...
+/// -# Configure the interrupt settings using NVIC_ConfigureIT
+/// -# Enable or disable interrupt generation of a particular source with
+///    NVIC_EnableIT and NVIC_DisableIT.
+///
+/// \note Most of the time, peripheral interrupts must be also configured
+/// inside the peripheral itself.
+//------------------------------------------------------------------------------
+
+#ifndef NVIC_H
+#define NVIC_H
+
+
+#endif //#ifndef NVIC_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/peripherals.dir b/usb-loader/samba_applets/at91lib/peripherals/peripherals.dir
new file mode 100644
index 0000000000000000000000000000000000000000..464b7432602ac450ce6c99d7cf5bad5f8a0350a3
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/peripherals.dir
@@ -0,0 +1,47 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+/// !!!Purpose
+///
+/// The #peripherals# directory stores a collection of basic APIs for each of
+/// the peripherals available on AT91 microcontrollers.
+///
+/// !!!Contents
+/// Each subdirectory inside this one provides code for a single peripheral. The
+/// directory is named according to the short-handed name of the peripheral, as
+/// written in the product datasheet (e.g. Advanced Interrupt Controller code
+/// is located in the #aic# directory).
+///
+/// Peripheral APIs provide low-level functions to simplify the use of
+/// AT91 peripherals. However, they do not provide fully-fledged drivers; such
+/// code can be found in the #drivers# directory of at91lib.
+//------------------------------------------------------------------------------
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pio/pio.c b/usb-loader/samba_applets/at91lib/peripherals/pio/pio.c
new file mode 100644
index 0000000000000000000000000000000000000000..288e6bbed0cb5528a1b94b0ddf92d0ad14079bcf
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pio/pio.c
@@ -0,0 +1,382 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "pio.h"
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Local Functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Configures one or more pin(s) of a PIO controller as being controlled by
+/// peripheral A. Optionally, the corresponding internal pull-up(s) can be
+/// enabled.
+/// \param pio  Pointer to a PIO controller.
+/// \param mask  Bitmask of one or more pin(s) to configure.
+/// \param enablePullUp  Indicates if the pin(s) internal pull-up shall be
+///                      configured.
+//------------------------------------------------------------------------------
+static void PIO_SetPeripheralA(
+    AT91S_PIO *pio,
+    unsigned int mask,
+    unsigned char enablePullUp)
+{
+#if !defined(AT91C_PIOA_ASR)
+    unsigned int abmr;
+#endif
+
+    // Disable interrupts on the pin(s)
+    pio->PIO_IDR = mask;
+
+    // Enable the pull-up(s) if necessary
+    if (enablePullUp) {
+
+        pio->PIO_PPUER = mask;
+    }
+    else {
+
+        pio->PIO_PPUDR = mask;
+    }
+
+    // Configure pin
+#if defined(AT91C_PIOA_ASR)
+    pio->PIO_ASR = mask;
+#else
+    abmr = pio->PIO_ABSR;
+    pio->PIO_ABSR &= (~mask & abmr);
+#endif
+    pio->PIO_PDR = mask;
+}
+
+//------------------------------------------------------------------------------
+/// Configures one or more pin(s) of a PIO controller as being controlled by
+/// peripheral B. Optionally, the corresponding internal pull-up(s) can be
+/// enabled.
+/// \param pio  Pointer to a PIO controller.
+/// \param mask  Bitmask of one or more pin(s) to configure.
+/// \param enablePullUp  Indicates if the pin(s) internal pull-up shall be
+///                      configured.
+//------------------------------------------------------------------------------
+static void PIO_SetPeripheralB(
+    AT91S_PIO *pio,
+    unsigned int mask,
+    unsigned char enablePullUp)
+{
+#if !defined(AT91C_PIOA_BSR)
+    unsigned int abmr;
+#endif
+
+    // Disable interrupts on the pin(s)
+    pio->PIO_IDR = mask;
+
+    // Enable the pull-up(s) if necessary
+    if (enablePullUp) {
+
+        pio->PIO_PPUER = mask;
+    }
+    else {
+
+        pio->PIO_PPUDR = mask;
+    }
+
+    // Configure pin
+#if defined(AT91C_PIOA_BSR)
+    pio->PIO_BSR = mask;
+#else
+    abmr = pio->PIO_ABSR;
+    pio->PIO_ABSR = mask | abmr;
+#endif
+    pio->PIO_PDR = mask;
+}
+
+#if defined(AT91C_PIOA_IFDGSR) //Glitch or Debouncing filter selection supported
+//------------------------------------------------------------------------------
+/// Configures Glitch or Debouncing filter for input
+/// \param pio      Pointer to a PIO controller.
+/// \param mask   Bitmask for filter selection.
+///                     each of 32 bit field, 0 is Glitch, 1 is Debouncing
+/// \param clkDiv  Clock divider if Debouncing select, using the lowest 14 bits
+///                     common for all PIO line of selecting deboucing filter
+//------------------------------------------------------------------------------
+static void PIO_SetFilter(
+    AT91S_PIO *pio,
+    unsigned int filterSel,
+    unsigned int clkDiv)
+{
+    pio->PIO_DIFSR = filterSel;//set Debouncing, 0 bit field no effect
+    pio->PIO_SCIFSR = ~filterSel;//set Glitch, 0 bit field no effect
+
+    pio->PIO_SCDR = clkDiv & 0x3FFF;//the lowest 14 bits work
+}
+#endif
+
+//------------------------------------------------------------------------------
+/// Configures one or more pin(s) or a PIO controller as inputs. Optionally,
+/// the corresponding internal pull-up(s) and glitch filter(s) can be
+/// enabled.
+/// \param pio  Pointer to a PIO controller.
+/// \param mask  Bitmask indicating which pin(s) to configure as input(s).
+/// \param enablePullUp  Indicates if the internal pull-up(s) must be enabled.
+/// \param enableFilter  Indicates if the glitch filter(s) must be enabled.
+//------------------------------------------------------------------------------
+static void PIO_SetInput(
+    AT91S_PIO *pio,
+    unsigned int mask,
+    unsigned char enablePullUp,
+    unsigned char enableFilter)
+{
+    // Disable interrupts
+    pio->PIO_IDR = mask;
+
+    // Enable pull-up(s) if necessary
+    if (enablePullUp) {
+    
+        pio->PIO_PPUER = mask;
+    }
+    else {
+    
+        pio->PIO_PPUDR = mask;
+    }
+
+    // Enable filter(s) if necessary
+    if (enableFilter) {
+    
+        pio->PIO_IFER = mask;
+    }
+    else {
+    
+        pio->PIO_IFDR = mask;
+    }
+
+    // Configure pin as input
+    pio->PIO_ODR = mask;
+    pio->PIO_PER = mask;
+}
+
+//------------------------------------------------------------------------------
+/// Configures one or more pin(s) of a PIO controller as outputs, with the
+/// given default value. Optionally, the multi-drive feature can be enabled
+/// on the pin(s).
+/// \param pio  Pointer to a PIO controller.
+/// \param mask  Bitmask indicating which pin(s) to configure.
+/// \param defaultValue  Default level on the pin(s).
+/// \param enableMultiDrive  Indicates if the pin(s) shall be configured as
+///                          open-drain.
+/// \param enablePullUp  Indicates if the pin shall have its pull-up activated.
+//------------------------------------------------------------------------------
+static void PIO_SetOutput(
+    AT91S_PIO *pio,
+    unsigned int mask,
+    unsigned char defaultValue,
+    unsigned char enableMultiDrive,
+    unsigned char enablePullUp)
+{
+    // Disable interrupts
+    pio->PIO_IDR = mask;
+
+    // Enable pull-up(s) if necessary
+    if (enablePullUp) {
+    
+        pio->PIO_PPUER = mask;
+    }
+    else {
+    
+        pio->PIO_PPUDR = mask;
+    }
+
+    // Enable multi-drive if necessary
+    if (enableMultiDrive) {
+    
+        pio->PIO_MDER = mask;
+    }
+    else {
+    
+        pio->PIO_MDDR = mask;
+    }
+
+    // Set default value
+    if (defaultValue) {
+
+        pio->PIO_SODR = mask;
+    }
+    else {
+
+        pio->PIO_CODR = mask;
+    }
+
+    // Configure pin(s) as output(s)
+    pio->PIO_OER = mask;
+    pio->PIO_PER = mask;
+}
+
+//------------------------------------------------------------------------------
+//         Global Functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Configures a list of Pin instances, each of which can either hold a single
+/// pin or a group of pins, depending on the mask value; all pins are configured
+/// by this function. The size of the array must also be provided and is easily
+/// computed using PIO_LISTSIZE whenever its length is not known in advance.
+/// \param list  Pointer to a list of Pin instances.
+/// \param size  Size of the Pin list (calculated using PIO_LISTSIZE).
+/// \return 1 if the pins have been configured properly; otherwise 0.
+//------------------------------------------------------------------------------
+unsigned char PIO_Configure(const Pin *list, unsigned int size)
+{
+    // Configure pins
+    while (size > 0) {
+    
+        switch (list->type) {
+    
+            case PIO_PERIPH_A:
+                PIO_SetPeripheralA(list->pio,
+                                   list->mask,
+                                   (list->attribute & PIO_PULLUP) ? 1 : 0);
+                break;
+    
+            case PIO_PERIPH_B:
+                PIO_SetPeripheralB(list->pio,
+                                   list->mask,
+                                   (list->attribute & PIO_PULLUP) ? 1 : 0);
+                break;
+    
+            case PIO_INPUT:
+                AT91C_BASE_PMC->PMC_PCER = 1 << list->id;
+                PIO_SetInput(list->pio,
+                             list->mask,
+                             (list->attribute & PIO_PULLUP) ? 1 : 0,
+                             (list->attribute & PIO_DEGLITCH)? 1 : 0);
+
+                #if defined(AT91C_PIOA_IFDGSR) //PIO3 with Glitch or Debouncing selection
+                //if glitch input filter enabled, set it
+                if(list->attribute & PIO_DEGLITCH)//Glitch input filter enabled
+                    PIO_SetFilter(list->pio,
+                        list->inFilter.filterSel,
+                        list->inFilter.clkDivider);
+                #endif
+                break;
+    
+            case PIO_OUTPUT_0:
+            case PIO_OUTPUT_1:
+                PIO_SetOutput(list->pio,
+                              list->mask,
+                              (list->type == PIO_OUTPUT_1),
+                              (list->attribute & PIO_OPENDRAIN) ? 1 : 0,
+                              (list->attribute & PIO_PULLUP) ? 1 : 0);
+                break;
+    
+            default: return 0;
+        }
+
+        list++;
+        size--;
+    }
+
+    return 1;
+}
+
+//------------------------------------------------------------------------------
+/// Sets a high output level on all the PIOs defined in the given Pin instance.
+/// This has no immediate effects on PIOs that are not output, but the PIO
+/// controller will memorize the value they are changed to outputs.
+/// \param pin  Pointer to a Pin instance describing one or more pins.
+//------------------------------------------------------------------------------
+void PIO_Set(const Pin *pin)
+{
+    pin->pio->PIO_SODR = pin->mask;
+}
+
+//------------------------------------------------------------------------------
+/// Sets a low output level on all the PIOs defined in the given Pin instance.
+/// This has no immediate effects on PIOs that are not output, but the PIO
+/// controller will memorize the value they are changed to outputs.
+/// \param pin  Pointer to a Pin instance describing one or more pins.
+//------------------------------------------------------------------------------
+void PIO_Clear(const Pin *pin)
+{
+    pin->pio->PIO_CODR = pin->mask;
+}
+
+//------------------------------------------------------------------------------
+/// Returns 1 if one or more PIO of the given Pin instance currently have a high
+/// level; otherwise returns 0. This method returns the actual value that is
+/// being read on the pin. To return the supposed output value of a pin, use
+/// PIO_GetOutputDataStatus() instead.
+/// \param pin  Pointer to a Pin instance describing one or more pins.
+/// \return 1 if the Pin instance contains at least one PIO that currently has
+/// a high level; otherwise 0.
+//------------------------------------------------------------------------------
+unsigned char PIO_Get(const Pin *pin)
+{
+    unsigned int reg;
+    if ((pin->type == PIO_OUTPUT_0) || (pin->type == PIO_OUTPUT_1)) {
+
+        reg = pin->pio->PIO_ODSR;
+    }
+    else {
+
+        reg = pin->pio->PIO_PDSR;
+    }
+
+    if ((reg & pin->mask) == 0) {
+
+        return 0;
+    }
+    else {
+
+        return 1;
+    }
+}
+
+
+//------------------------------------------------------------------------------
+/// Returns 1 if one or more PIO of the given Pin are configured to output a
+/// high level (even if they are not output).
+/// To get the actual value of the pin, use PIO_Get() instead.
+/// \param pin  Pointer to a Pin instance describing one or more pins.
+/// \return 1 if the Pin instance contains at least one PIO that is configured
+/// to output a high level; otherwise 0.
+//------------------------------------------------------------------------------
+unsigned char PIO_GetOutputDataStatus(const Pin *pin)
+{
+    if ((pin->pio->PIO_ODSR & pin->mask) == 0) {
+
+        return 0;
+    }
+    else {
+
+        return 1;
+    }
+}
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pio/pio.dir b/usb-loader/samba_applets/at91lib/peripherals/pio/pio.dir
new file mode 100644
index 0000000000000000000000000000000000000000..949667205c494f1b9570901c239f0c9a5c21d989
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pio/pio.dir
@@ -0,0 +1,50 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+///
+/// This directory contains an API for configuring the Peripheral Input/Output
+/// (PIO) controllers.
+///
+/// !!!Contents
+///
+/// The code is separated into two components:
+///    - pio.c contains code for PIO initialisation, as well as set/clear/get
+///      methods that can be used with user-controlled pins.
+///    - pio_it.h provides a convenient interface for configuring, enabling or
+///      disabling interrupts on one pin or a group of pins.
+///
+/// The reasoning behing this division is that pio_it.c requires the aic
+/// peripheral, which generates useless includes for project which do not use
+/// PIO interrupts.
+//------------------------------------------------------------------------------
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pio/pio.h b/usb-loader/samba_applets/at91lib/peripherals/pio/pio.h
new file mode 100644
index 0000000000000000000000000000000000000000..2c78d731bfc6bfdefb586d5e803c16104951add6
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pio/pio.h
@@ -0,0 +1,225 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !!!Purpose
+/// 
+/// This file provides a basic API for PIO configuration and usage of
+/// user-controlled pins. Please refer to the board.h file for a list of
+/// available pin definitions.
+/// 
+/// !!!Usage
+/// 
+/// -# Define a constant pin description array such as the following one, using
+///    the existing definitions provided by the board.h file if possible:
+///    \code
+///       const Pin pPins[] = {PIN_USART0_TXD, PIN_USART0_RXD};
+///    \endcode
+///    Alternatively, it is possible to add new pins by provided the full Pin
+///    structure:
+///    \code
+///    // Pin instance to configure PA10 & PA11 as inputs with the internal
+///    // pull-up enabled.
+///    const Pin pPins = {
+///         (1 << 10) | (1 << 11),
+///         AT91C_BASE_PIOA,
+///         AT91C_ID_PIOA,
+///         PIO_INPUT,
+///         PIO_PULLUP
+///    };
+///    \endcode
+/// -# Configure a pin array by calling PIO_Configure() with a pointer to the
+///    array and its size (which is computed using the PIO_LISTSIZE macro).
+/// -# Change and get the value of a user-controlled pin using the PIO_Set,
+///    PIO_Clear and PIO_Get methods.
+/// -# Get the level being currently output by a user-controlled pin configured
+///    as an output using PIO_GetOutputDataStatus().
+//------------------------------------------------------------------------------
+ 
+#ifndef PIO_H
+#define PIO_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Global Definitions
+//------------------------------------------------------------------------------
+
+/// The pin is controlled by the associated signal of peripheral A.
+#define PIO_PERIPH_A                0
+/// The pin is controlled by the associated signal of peripheral B.
+#define PIO_PERIPH_B                1
+/// The pin is an input.
+#define PIO_INPUT                   2
+/// The pin is an output and has a default level of 0.
+#define PIO_OUTPUT_0                3
+/// The pin is an output and has a default level of 1.
+#define PIO_OUTPUT_1                4
+
+/// Default pin configuration (no attribute).
+#define PIO_DEFAULT                 (0 << 0)
+/// The internal pin pull-up is active.
+#define PIO_PULLUP                  (1 << 0)
+/// The internal glitch filter is active.
+#define PIO_DEGLITCH                (1 << 1)
+/// The pin is open-drain.
+#define PIO_OPENDRAIN               (1 << 2)
+
+//------------------------------------------------------------------------------
+//         Global Macros
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Calculates the size of an array of Pin instances. The array must be defined
+/// locally (i.e. not a pointer), otherwise the computation will not be correct.
+/// \param pPins  Local array of Pin instances.
+/// \return Number of elements in array.
+//------------------------------------------------------------------------------
+#define PIO_LISTSIZE(pPins)    (sizeof(pPins) / sizeof(Pin))
+
+//------------------------------------------------------------------------------
+//         Global Types
+//------------------------------------------------------------------------------
+typedef struct _ExtIntMode {
+  ///indicate which pin to enable/disable additional Interrupt mode
+  ///each of 32 bit field represents one PIO line.
+  unsigned int itMask;
+  ///select Edge or level interrupt detection source
+  ///each of 32 bit field represents one PIO line, 0 is Edge, 1 is Level
+  unsigned int edgeLvlSel;
+  ///select rising/high or falling/low detection event
+  ///each of 32 bit field represents one PIO line:
+  ///0 is Falling Edge detection event (if selected Edge interrupt 
+  ///   detection source, or Low Level detection (if selected
+  ///   Level interrupt detection source;
+  ///1 is Rising Edge detection(if selected Edge interrupt 
+  ///   source, or Low Level detection event(if selected Level
+  ///   interrupt detection source.
+  unsigned int lowFallOrRiseHighSel;
+
+} ExtIntMode;
+
+typedef struct _GlitchDeBounceFilter {
+  ///Select Glitch/Debounce filtering for PIO input
+  ///each of 32 bit field represents one PIO line
+  ///0 is Glitch, 1 is Debouncing
+  unsigned int filterSel;
+  ///slow clock divider selection for Debouncing filter
+  unsigned int clkDivider:14;
+
+} GlitchDebounceFilter;
+
+//------------------------------------------------------------------------------
+/// Describes the type and attribute of one PIO pin or a group of similar pins.
+/// The #type# field can have the following values:
+///    - PIO_PERIPH_A
+///    - PIO_PERIPH_B
+///    - PIO_OUTPUT_0
+///    - PIO_OUTPUT_1
+///    - PIO_INPUT
+///
+/// The #attribute# field is a bitmask that can either be set to PIO_DEFAULt,
+/// or combine (using bitwise OR '|') any number of the following constants:
+///    - PIO_PULLUP
+///    - PIO_DEGLITCH
+///    - PIO_OPENDRAIN
+//------------------------------------------------------------------------------
+typedef struct {
+
+    /// Bitmask indicating which pin(s) to configure.
+    unsigned int mask; 
+    /// Pointer to the PIO controller which has the pin(s).
+    AT91S_PIO    *pio;
+    /// Peripheral ID of the PIO controller which has the pin(s).
+    unsigned char id;
+    /// Pin type.
+    unsigned char type;
+    /// Pin attribute.
+    unsigned char attribute;
+#if defined(AT91C_PIOA_AIMMR)
+    ///Additional Interrupt Mode
+    ExtIntMode itMode;
+#endif
+
+#if defined(AT91C_PIOA_IFDGSR)
+    ///Glitch/Debouncing filter
+    GlitchDebounceFilter inFilter;
+#endif
+
+} Pin;
+
+//------------------------------------------------------------------------------
+//         Global Access Macros 
+//------------------------------------------------------------------------------
+
+//Get Glitch input filter enable/disable status
+#define PIO_GetIFSR(pPin)	((pPin)->pio->PIO_IFSR)
+
+//Get Glitch/Deboucing selection status
+#define PIO_GetIFDGSR(pPin) ((pPin)->pio->PIO_IFDGSR)
+
+//Get Additional PIO interrupt mode mask status
+#define PIO_GetAIMMR(pPin)  ((pPin)->pio->PIO_AIMMR)
+
+//Get Interrupt status
+#define PIO_GetISR(pPin)	((pPin)->pio->PIO_ISR)
+
+//Get Edge or Level selection status
+#define PIO_GetELSR(pPin)	((pPin)->pio->PIO_ELSR)
+
+//Get Fall/Rise or Low/High selection status
+#define PIO_GetFRLHSR(pPin)	((pPin)->pio->PIO_FRLHSR)
+
+//Get PIO Lock Status
+#define PIO_GetLockStatus(pPin) ((pPin)->pio->PIO_LOCKSR)
+
+//------------------------------------------------------------------------------
+//         Global Functions
+//------------------------------------------------------------------------------
+
+extern unsigned char PIO_Configure(const Pin *list, unsigned int size);
+
+extern void PIO_Set(const Pin *pin);
+
+extern void PIO_Clear(const Pin *pin);
+
+extern unsigned char PIO_Get(const Pin *pin);
+
+//extern unsigned int PIO_GetISR(const Pin *pin);
+
+extern unsigned char PIO_GetOutputDataStatus(const Pin *pin);
+
+#endif //#ifndef PIO_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pio/pio_it.c b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_it.c
new file mode 100644
index 0000000000000000000000000000000000000000..cdd8a0bb8e597e99aaa5257c8336892aec51b381
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_it.c
@@ -0,0 +1,461 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+/// Disable traces for this file
+#undef TRACE_LEVEL
+#define TRACE_LEVEL 0
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "pio_it.h"
+#include "pio.h"
+#include <board.h>
+#include <irq/irq.h>
+#include <utility/assert.h>
+#include <utility/trace.h>
+
+//------------------------------------------------------------------------------
+//         Local definitions
+//------------------------------------------------------------------------------
+
+/// \exclude
+/// Maximum number of interrupt sources that can be defined. This
+/// constant can be increased, but the current value is the smallest possible
+/// that will be compatible with all existing projects.
+#define MAX_INTERRUPT_SOURCES       7
+
+//------------------------------------------------------------------------------
+//         Local types
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \exclude
+/// Describes a PIO interrupt source, including the PIO instance triggering the
+/// interrupt and the associated interrupt handler.
+//------------------------------------------------------------------------------
+typedef struct {
+
+    /// Pointer to the source pin instance.
+    const Pin *pPin;
+
+    /// Interrupt handler.
+    void (*handler)(const Pin *);
+
+} InterruptSource;
+
+//------------------------------------------------------------------------------
+//         Local variables
+//------------------------------------------------------------------------------
+
+/// List of interrupt sources.
+static InterruptSource pSources[MAX_INTERRUPT_SOURCES];
+
+/// Number of currently defined interrupt sources.
+static unsigned int numSources;
+
+//------------------------------------------------------------------------------
+//         Local functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Handles all interrupts on the given PIO controller.
+/// \param id  PIO controller ID.
+/// \param pPio  PIO controller base address.
+//------------------------------------------------------------------------------
+static void PioInterruptHandler(unsigned int id, AT91S_PIO *pPio)
+{
+    unsigned int status;
+    unsigned int i;
+
+    // Read PIO controller status
+    status = pPio->PIO_ISR;
+    status &= pPio->PIO_IMR;
+
+    // Check pending events
+    if (status != 0) {
+
+        TRACE_DEBUG("PIO interrupt on PIO controller #%d\n\r", id);
+
+        // Find triggering source
+        i = 0;
+        while (status != 0) {
+
+            // There cannot be an unconfigured source enabled.
+            SANITY_CHECK(i < numSources);
+
+            // Source is configured on the same controller
+            if (pSources[i].pPin->id == id) {
+
+                // Source has PIOs whose statuses have changed
+                if ((status & pSources[i].pPin->mask) != 0) {
+
+                    TRACE_DEBUG("Interrupt source #%d triggered\n\r", i);
+
+                    pSources[i].handler(pSources[i].pPin);
+                    status &= ~(pSources[i].pPin->mask);
+                }
+            }
+            i++;
+        }
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Generic PIO interrupt handler. Single entry point for interrupts coming
+/// from any PIO controller (PIO A, B, C ...). Dispatches the interrupt to
+/// the user-configured handlers.
+//------------------------------------------------------------------------------
+void PIO_IT_InterruptHandler(void)
+{
+#if defined(AT91C_ID_PIOA)
+    // Treat PIOA interrupts
+    PioInterruptHandler(AT91C_ID_PIOA, AT91C_BASE_PIOA);
+#endif
+
+#if defined(AT91C_ID_PIOB)
+    // Treat PIOB interrupts
+    PioInterruptHandler(AT91C_ID_PIOB, AT91C_BASE_PIOB);
+#endif
+
+#if defined(AT91C_ID_PIOC)
+    // Treat PIOC interrupts
+    PioInterruptHandler(AT91C_ID_PIOC, AT91C_BASE_PIOC);
+#endif
+
+#if defined(AT91C_ID_PIOD)
+    // Treat PIOD interrupts
+    PioInterruptHandler(AT91C_ID_PIOD, AT91C_BASE_PIOD);
+#endif
+
+#if defined(AT91C_ID_PIOE)
+    // Treat PIOE interrupts
+    PioInterruptHandler(AT91C_ID_PIOE, AT91C_BASE_PIOE);
+#endif
+
+#if defined(AT91C_ID_PIOABCD)
+    // Treat PIOABCD interrupts
+    #if !defined(AT91C_ID_PIOA)
+        PioInterruptHandler(AT91C_ID_PIOABCD, AT91C_BASE_PIOA);
+    #endif
+    #if !defined(AT91C_ID_PIOB)
+        PioInterruptHandler(AT91C_ID_PIOABCD, AT91C_BASE_PIOB);
+    #endif
+    #if !defined(AT91C_ID_PIOC)
+        PioInterruptHandler(AT91C_ID_PIOABCD, AT91C_BASE_PIOC);
+    #endif
+    #if !defined(AT91C_ID_PIOD)
+        PioInterruptHandler(AT91C_ID_PIOABCD, AT91C_BASE_PIOD);
+    #endif
+#endif
+
+#if defined(AT91C_ID_PIOABCDE)
+    // Treat PIOABCDE interrupts
+    #if !defined(AT91C_ID_PIOA)
+        PioInterruptHandler(AT91C_ID_PIOABCDE, AT91C_BASE_PIOA);
+    #endif
+    #if !defined(AT91C_ID_PIOB)
+        PioInterruptHandler(AT91C_ID_PIOABCDE, AT91C_BASE_PIOB);
+    #endif
+    #if !defined(AT91C_ID_PIOC)
+        PioInterruptHandler(AT91C_ID_PIOABCDE, AT91C_BASE_PIOC);
+    #endif
+    #if !defined(AT91C_ID_PIOD)
+        PioInterruptHandler(AT91C_ID_PIOABCDE, AT91C_BASE_PIOD);
+    #endif
+    #if !defined(AT91C_ID_PIOE)
+        PioInterruptHandler(AT91C_ID_PIOABCDE, AT91C_BASE_PIOE);
+    #endif
+#endif
+
+#if defined(AT91C_ID_PIOCDE)
+    // Treat PIOCDE interrupts
+    #if !defined(AT91C_ID_PIOC)
+        PioInterruptHandler(AT91C_ID_PIOCDE, AT91C_BASE_PIOC);
+    #endif
+    #if !defined(AT91C_ID_PIOD)
+        PioInterruptHandler(AT91C_ID_PIOCDE, AT91C_BASE_PIOD);
+    #endif
+    #if !defined(AT91C_ID_PIOE)
+        PioInterruptHandler(AT91C_ID_PIOCDE, AT91C_BASE_PIOE);
+    #endif
+#endif
+}
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Initializes the PIO interrupt management logic. The desired priority of PIO
+/// interrupts must be provided. Calling this function multiple times result in
+/// the reset of currently configured interrupts.
+/// \param priority  PIO controller interrupts priority.
+//------------------------------------------------------------------------------
+void PIO_InitializeInterrupts(unsigned int priority)
+{
+    TRACE_DEBUG("PIO_Initialize()\n\r");
+
+//    SANITY_CHECK((priority & ~AT91C_AIC_PRIOR) == 0);
+
+    // Reset sources
+    numSources = 0;
+
+#ifdef AT91C_ID_PIOA
+    // Configure PIO interrupt sources
+    TRACE_DEBUG("PIO_Initialize: Configuring PIOA\n\r");
+    AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOA;
+    AT91C_BASE_PIOA->PIO_ISR;
+    AT91C_BASE_PIOA->PIO_IDR = 0xFFFFFFFF;
+    IRQ_ConfigureIT(AT91C_ID_PIOA, priority, PIO_IT_InterruptHandler);
+    IRQ_EnableIT(AT91C_ID_PIOA);
+#endif
+
+#ifdef AT91C_ID_PIOB
+    TRACE_DEBUG("PIO_Initialize: Configuring PIOB\n\r");
+    AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOB;
+    AT91C_BASE_PIOB->PIO_ISR;
+    AT91C_BASE_PIOB->PIO_IDR = 0xFFFFFFFF;
+    IRQ_ConfigureIT(AT91C_ID_PIOB, priority, PIO_IT_InterruptHandler);
+    IRQ_EnableIT(AT91C_ID_PIOB);
+#endif
+
+#ifdef AT91C_ID_PIOC
+    TRACE_DEBUG("PIO_Initialize: Configuring PIOC\n\r");
+    AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOC;
+    AT91C_BASE_PIOC->PIO_ISR;
+    AT91C_BASE_PIOC->PIO_IDR = 0xFFFFFFFF;
+    IRQ_ConfigureIT(AT91C_ID_PIOC, priority, PIO_IT_InterruptHandler);
+    IRQ_EnableIT(AT91C_ID_PIOC);
+#endif
+
+#ifdef AT91C_ID_PIOD
+    TRACE_DEBUG("PIO_Initialize: Configuring PIOD\n\r");
+    AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOD;
+    AT91C_BASE_PIOC->PIO_ISR;
+    AT91C_BASE_PIOC->PIO_IDR = 0xFFFFFFFF;
+    IRQ_ConfigureIT(AT91C_ID_PIOD, priority, PIO_IT_InterruptHandler);
+    IRQ_EnableIT(AT91C_ID_PIOD);
+#endif
+
+#ifdef AT91C_ID_PIOE
+    TRACE_DEBUG("PIO_Initialize: Configuring PIOE\n\r");
+    AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOE;
+    AT91C_BASE_PIOC->PIO_ISR;
+    AT91C_BASE_PIOC->PIO_IDR = 0xFFFFFFFF;
+    IRQ_ConfigureIT(AT91C_ID_PIOE, priority, PIO_IT_InterruptHandler);
+    IRQ_EnableIT(AT91C_ID_PIOE);
+#endif
+
+#if defined(AT91C_ID_PIOABCD)
+    // Treat PIOABCD interrupts
+    #if !defined(AT91C_ID_PIOA) \
+     && !defined(AT91C_ID_PIOB) \
+     && !defined(AT91C_ID_PIOC) \
+     && !defined(AT91C_ID_PIOD)
+
+        TRACE_DEBUG("PIO_Initialize: Configuring PIOABCD\n\r");
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOABCD;
+        AT91C_BASE_PIOA->PIO_ISR;
+        AT91C_BASE_PIOA->PIO_IDR = 0xFFFFFFFF;
+        IRQ_ConfigureIT(AT91C_ID_PIOABCD, priority, PIO_IT_InterruptHandler);
+        IRQ_EnableIT(AT91C_ID_PIOABCD);
+    #endif
+#endif
+
+#if defined(AT91C_ID_PIOABCDE)
+    // Treat PIOABCDE interrupts
+    #if !defined(AT91C_ID_PIOA) \
+     && !defined(AT91C_ID_PIOB) \
+     && !defined(AT91C_ID_PIOC) \
+     && !defined(AT91C_ID_PIOD) \
+     && !defined(AT91C_ID_PIOE)
+
+        TRACE_DEBUG("PIO_Initialize: Configuring PIOABCDE\n\r");
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOABCDE;
+        AT91C_BASE_PIOA->PIO_ISR;
+        AT91C_BASE_PIOA->PIO_IDR = 0xFFFFFFFF;
+        IRQ_ConfigureIT(AT91C_ID_PIOABCDE, priority, PIO_IT_InterruptHandler);
+        IRQ_EnableIT(AT91C_ID_PIOABCDE);
+    #endif
+#endif
+
+#if defined(AT91C_ID_PIOCDE)
+    // Treat PIOCDE interrupts
+    #if !defined(AT91C_ID_PIOC) \
+     && !defined(AT91C_ID_PIOD) \
+     && !defined(AT91C_ID_PIOE)
+
+        TRACE_DEBUG("PIO_Initialize: Configuring PIOC\n\r");
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_PIOCDE;
+        AT91C_BASE_PIOC->PIO_ISR;
+        AT91C_BASE_PIOC->PIO_IDR = 0xFFFFFFFF;
+        IRQ_ConfigureIT(AT91C_ID_PIOCDE, priority, PIO_IT_InterruptHandler);
+        IRQ_EnableIT(AT91C_ID_PIOCDE);
+    #endif
+#endif
+}
+
+//------------------------------------------------------------------------------
+/// Configures a PIO or a group of PIO to generate an interrupt on status
+/// change. The provided interrupt handler will be called with the triggering
+/// pin as its parameter (enabling different pin instances to share the same
+/// handler).
+/// \param pPin  Pointer to a Pin instance.
+/// \param handler  Interrupt handler function pointer.
+//------------------------------------------------------------------------------
+void PIO_ConfigureIt(const Pin *pPin, void (*handler)(const Pin *))
+{
+    InterruptSource *pSource;
+
+    TRACE_DEBUG("PIO_ConfigureIt()\n\r");
+
+    SANITY_CHECK(pPin);
+    ASSERT(numSources < MAX_INTERRUPT_SOURCES,
+           "-F- PIO_ConfigureIt: Increase MAX_INTERRUPT_SOURCES\n\r");
+
+    // Define new source
+    TRACE_DEBUG("PIO_ConfigureIt: Defining new source #%d.\n\r",  numSources);
+
+    pSource = &(pSources[numSources]);
+    pSource->pPin = pPin;
+    pSource->handler = handler;
+    numSources++;
+}
+
+//------------------------------------------------------------------------------
+/// Enables the given interrupt source if it has been configured. The status
+/// register of the corresponding PIO controller is cleared prior to enabling
+/// the interrupt.
+/// \param pPin  Interrupt source to enable.
+//------------------------------------------------------------------------------
+void PIO_EnableIt(const Pin *pPin)
+{
+    TRACE_DEBUG("PIO_EnableIt()\n\r");
+
+    SANITY_CHECK(pPin);
+
+#ifndef NOASSERT
+    unsigned int i = 0;
+    unsigned char found = 0;
+    while ((i < numSources) && !found) {
+
+        if (pSources[i].pPin == pPin) {
+
+            found = 1;
+        }
+        i++;
+    }
+    ASSERT(found, "-F- PIO_EnableIt: Interrupt source has not been configured\n\r");
+#endif
+
+    pPin->pio->PIO_ISR;
+    pPin->pio->PIO_IER = pPin->mask;
+    
+
+#if defined(AT91C_PIOA_AIMMR)
+    //PIO3 with additional interrupt support
+    //configure additional interrupt mode registers
+    if(pPin->mask&pPin->itMode.itMask) {
+   
+    //enable additional interrupt mode
+    pPin->pio->PIO_AIMER  = pPin->itMode.itMask;
+    
+    if(pPin->mask&pPin->itMode.edgeLvlSel)
+        //if bit field of selected pin is 1, set as Level detection source
+        pPin->pio->PIO_LSR = pPin->itMode.edgeLvlSel;
+    else
+        //if bit field of selected pin is 0, set as Edge detection source
+        pPin->pio->PIO_ESR = ~(pPin->itMode.edgeLvlSel);
+
+    if(pPin->mask&pPin->itMode.lowFallOrRiseHighSel)
+        //if bit field of selected pin is 1, set as Rising Edge/High level detection event
+        pPin->pio->PIO_REHLSR     = pPin->itMode.lowFallOrRiseHighSel;
+    else
+        //if bit field of selected pin is 0, set as Falling Edge/Low level detection event
+        pPin->pio->PIO_FELLSR     = ~(pPin->itMode.lowFallOrRiseHighSel);
+    }
+
+#endif
+}
+
+//------------------------------------------------------------------------------
+/// Disables a given interrupt source, with no added side effects.
+/// \param pPin  Interrupt source to disable.
+//------------------------------------------------------------------------------
+void PIO_DisableIt(const Pin *pPin)
+{
+    SANITY_CHECK(pPin);
+
+    TRACE_DEBUG("PIO_DisableIt()\n\r");
+
+    pPin->pio->PIO_IDR = pPin->mask;
+#if defined(AT91C_PIOA_AIMMR)
+    if(pPin->mask & pPin->itMode.itMask)
+        //disable additional interrupt mode
+        pPin->pio->PIO_AIMDR = pPin->mask & pPin->itMode.itMask;
+#endif
+
+}
+
+#if defined(cortexm3)
+//------------------------------------------------------------------------------
+/// Override cortex-m3's default PIOA irq handler
+//------------------------------------------------------------------------------
+void PIOA_IrqHandler(void)
+{
+    #if defined(AT91C_ID_PIOA)
+    // Treat PIOA interrupts
+    PioInterruptHandler(AT91C_ID_PIOA, AT91C_BASE_PIOA);
+    #endif
+}
+
+//------------------------------------------------------------------------------
+/// Override cortex-m3's default PIOB irq handler
+//------------------------------------------------------------------------------
+void PIOB_IrqHandler(void)
+{
+    #if defined(AT91C_ID_PIOB)
+    // Treat PIOA interrupts
+    PioInterruptHandler(AT91C_ID_PIOB, AT91C_BASE_PIOB);
+    #endif
+}
+
+//------------------------------------------------------------------------------
+/// Override cortex-m3's default PIOC irq handler
+//------------------------------------------------------------------------------
+void PIOC_IrqHandler(void)
+{
+    #if defined(AT91C_ID_PIOC)
+    // Treat PIOA interrupts
+    PioInterruptHandler(AT91C_ID_PIOC, AT91C_BASE_PIOC);
+    #endif
+}
+#endif
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pio/pio_it.h b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_it.h
new file mode 100644
index 0000000000000000000000000000000000000000..782e911a77806f35225e8acea1f4172394368ab8
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_it.h
@@ -0,0 +1,85 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !!!Purpose
+/// 
+/// Configuration and handling of interrupts on PIO status changes. The API
+/// provided here have several advantages over the traditional PIO interrupt
+/// configuration approach:
+///    - It is highly portable
+///    - It automatically demultiplexes interrupts when multiples pins have been
+///      configured on a single PIO controller
+///    - It allows a group of pins to share the same interrupt
+/// 
+/// However, it also has several minor drawbacks that may prevent from using it
+/// in particular applications:
+///    - It enables the clocks of all PIO controllers
+///    - PIO controllers all share the same interrupt handler, which does the
+///      demultiplexing and can be slower than direct configuration
+///    - It reserves space for a fixed number of interrupts, which can be
+///      increased by modifying the appropriate constant in pio_it.c.
+///
+/// !!!Usage
+/// 
+/// -# Initialize the PIO interrupt mechanism using PIO_InitializeInterrupts()
+///    with the desired priority (0 ... 7).
+/// -# Configure a status change interrupt on one or more pin(s) with
+///    PIO_ConfigureIt().
+/// -# Enable & disable interrupts on pins using PIO_EnableIt() and
+///    PIO_DisableIt().
+//------------------------------------------------------------------------------
+
+#ifndef PIO_IT_H
+#define PIO_IT_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "pio.h"
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+extern void PIO_InitializeInterrupts(unsigned int priority);
+
+extern void PIO_ConfigureIt(const Pin *pPin, void (*handler)(const Pin *));
+
+extern void PIO_EnableIt(const Pin *pPin);
+
+extern void PIO_DisableIt(const Pin *pPin);
+
+extern void PIO_IT_InterruptHandler(void);
+
+#endif //#ifndef PIO_IT_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pio/pio_keypad.c b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_keypad.c
new file mode 100644
index 0000000000000000000000000000000000000000..e617289ea29274401b41555c3fb995999de384fc
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_keypad.c
@@ -0,0 +1,147 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+#include "pio.h"
+#include "pio_keypad.h"
+
+
+//------------------------------------------------------------------------------
+//         Global Functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Configures keypad controller
+/// \param pPIO	Pointer to a PIO instance
+/// \param config  Configuration data for given pin,see head file for detail
+//------------------------------------------------------------------------------
+void PIO_KeyPadConfig(AT91S_PIO *pPIO, KeyPadConfig *config)
+{
+    //enable/disable keypad controller 
+    pPIO->PIO_KER = config->enable;
+
+    //if enable, set keypad matrix and debouncing
+    if(config->enable == TRUE) {
+        //set key matrix
+        pPIO->PIO_KRCR = (config->row | config->col<<8) ;
+
+        //set debouncing
+         pPIO->PIO_KDR = config->debouncing;
+
+    }
+}
+
+
+//------------------------------------------------------------------------------
+/// Get Key Press/Release status
+/// \param pPIO  Pointer to a PIO instance
+/// \param event  Pointer to a instance of KeyEvent for storing keypad status
+//------------------------------------------------------------------------------
+void PIO_GetKeyStatus(AT91S_PIO *pPIO, KeyEvent *event)
+{
+    int i,j;
+    
+    //get key press event
+    event->kdEvent.press = (pPIO->KSR&0x1)?TRUE:FALSE;
+    event->kdEvent.keyPressNum = (pPIO->KSR>>8)&0x3;
+    j=event->kdEvent.keyPressNum+1;
+    for(i=0; i<j; i++) {
+        event->kdEvent.preKeyMatrix[i].row = ((pPIO->KKPR) >> (8*i)) & 0x7;
+        event->kdEvent.preKeyMatrix[i].col = ((pPIO->KKPR) >> (8*i+4)) & 0x7;
+    }
+
+    //get key release event
+    event->kuEvent.release = ((pPIO->KSR>>1) & 0x1)?TRUE:FALSE;
+    event->kuEvent.keyRelNum = (pPIO->KSR>>16)&0x3;
+    j=event->kdEvent.keyPressNum+1;
+    for(i=0;i<j;i++) {
+        event->kuEvent.relKeyMatrix[i].row = ((pPIO->KKRR) >> (8*i)) & 0x7;
+        event->kuEvent.relKeyMatrix[i].col = ((pPIO->KKRR) >> (8*i+4)) & 0x7;
+    }
+
+}
+
+
+//------------------------------------------------------------------------------
+/// Enable keypad interrupt as Key Press Interrupt or Key Release Interrupt or both
+/// \param pPIO Pointer to a PIO instance
+/// \param mode  Select key interrupt mode to enable, 
+///		0x1 		Key Press Interrupt
+///		0x2		Key Release Interrupt
+///		0x3		both of two type
+//------------------------------------------------------------------------------
+void PIO_KeypadEnableIt(AT91S_PIO *pPIO, unsigned int mode)
+{
+    switch(mode){
+    case 1:PIO_KeyPadEnableKPIt(pPIO);
+	   break;
+
+    case 2:PIO_KeyPadEnableKRIt(pPIO);
+	   break;
+
+    case 3:PIO_KeyPadEnableKPIt(pPIO);
+	   PIO_KeyPadEnableKRIt(pPIO);
+	   break;
+
+	default:break;
+    }
+
+}
+
+//------------------------------------------------------------------------------
+/// Disable Key Press Interrupt or Key Release Interrupt or both of them
+/// \param pPIO Pointer to a PIO instance
+/// \param mode  Select key interrupt mode to disable, 
+///		0x1 		Key Press Interrupt
+///		0x2		Key Release Interrupt
+///		0x3		both of two type
+//------------------------------------------------------------------------------
+void PIO_KeypadDisableIt(AT91S_PIO *pPIO, unsigned int mode)
+{
+    switch(mode){
+        case 1:PIO_KeyPadDisableKPIt(pPIO);
+   	       break;
+
+        case 2:PIO_KeyPadDisableKRIt(pPIO);
+   	       break;
+
+        case 3:PIO_KeyPadDisableKPIt(pPIO);
+    	       PIO_KeyPadDisableKRIt(pPIO);
+    	       break;
+
+        default:break;
+    }
+
+}
+
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pio/pio_keypad.h b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_keypad.h
new file mode 100644
index 0000000000000000000000000000000000000000..166f0668001b975db32a9f8677b7d5832a3f72bb
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pio/pio_keypad.h
@@ -0,0 +1,153 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+#ifndef PIO_KEYPAD_H
+#define PIO_KEYPAD_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Global Definitions
+//------------------------------------------------------------------------------
+
+
+
+
+//------------------------------------------------------------------------------
+//         Global Macros
+//------------------------------------------------------------------------------
+//enable keypad press interrupt
+#define PIO_KeyPadEnableKPIt(pPIO)	((pPIO)->KIER = 1<<0)
+
+//enable keypad release interrupt
+#define PIO_KeyPadEnableKRIt(pPIO)	((pPIO)->KIER = 1<<1)
+
+//disable keypad press interrupt
+#define PIO_KeyPadDisableKPIt(pPIO)	((pPIO)->KIDR = 1<<0)
+
+//disable keypad release interrupt
+#define PIO_KeyPadDisableKRIt(pPIO)	((pPIO)->KIDR = 1<<1)
+
+//enable keypad controller interrupt
+#define PIO_KeyPadEnableIt(pPIO, mode)	{switch(mode):\
+						case 1:PIO_KeyPadEnableKPIt(pPIO);break;\
+						case 2:PIO_KeyPadEnableKRIt(pPIO);break;\
+						case 3:PIO_KeyPadEnableKPIt(pPIO);\
+						       PIO_KeyPadEnableKRIt(pPIO);break;\
+						default:break;\
+					}
+
+//disable keypad controller interrupt
+#define PIO_KeyPadDisableIt(pPIO, mode) {switch(mode):\
+						case 1:PIO_KeyPadDisableKPIt(pPIO);break;\
+						case 2:PIO_KeyPadDisableKRIt(pPIO);break;\
+						case 3:PIO_KeyPadDisableKPIt(pPIO);\
+						       PIO_KeyPadDisableKRIt(pPIO);break;\
+						default:break;\
+					}
+
+//get keypad controller interrupt mask
+#define PIO_KeyPadGetItMask(pPIO)	((pPIO)->PIO_KIMR)
+
+
+//------------------------------------------------------------------------------
+/// Calculates the size of an array of Pin instances. The array must be defined
+/// locally (i.e. not a pointer), otherwise the computation will not be correct.
+/// \param pPins  Local array of Pin instances.
+/// \return Number of elements in array.
+//------------------------------------------------------------------------------
+#define PIO_LISTSIZE(pPins)    (sizeof(pPins) / sizeof(Pin))
+
+//------------------------------------------------------------------------------
+//         Global Types
+//------------------------------------------------------------------------------
+typedef enum {
+	FALSE,
+	TRUE
+} bool;
+
+typedef struct _KeyPadConfig {
+	bool enable;//keypad controller enable or disable
+	unsigned char col:3;//config column size
+	unsigned char row:3;//config row size
+        unsigned int debouncing;//config debouncing
+} KeyPadConfig;
+
+
+typedef struct _KeyColRow {
+      unsigned char row:3;
+      unsigned char col:3;
+} KeyColRow;
+
+ 
+typedef struct _KeyDownEvent {
+      bool press;//at least 1 pressed key detected, or 0
+      unsigned char keyPressNum;//simultaneously pressed key number
+      KeyColRow preKeyMatrix[4];//pressed key matrix
+} KeyDownEvent;
+
+ 
+
+typedef struct _KeyUpEvent {
+      bool release;//at least 1 released key  detected, or 0
+      unsigned char keyRelNum;//simultaneously released key number
+      KeyColRow relKeyMatrix[4];//released key matrix
+} KeyUpEvent;
+
+      
+
+typedef struct _KeyEvent {
+      KeyDownEvent kdEvent;
+      KeyUpEvent   kuEvent;
+} KeyEvent;
+
+//------------------------------------------------------------------------------
+//         Global Access Macros 
+//------------------------------------------------------------------------------
+
+
+//------------------------------------------------------------------------------
+//         Global Functions
+//------------------------------------------------------------------------------
+
+void PIO_KeyPadConfig(AT91S_PIO *pPIO, KeyPadConfig *config);
+
+void PIO_GetKeyStatus(AT91S_PIO *pPIO, KeyEvent *event);
+
+void PIO_KeypadEnableIt(AT91S_PIO *pio, unsigned int mode);
+
+void PIO_KeypadDisableIt(AT91S_PIO *pio, unsigned int mode);
+
+
+#endif //#ifndef PIO_KEYPAD_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pmc/pmc.c b/usb-loader/samba_applets/at91lib/peripherals/pmc/pmc.c
new file mode 100644
index 0000000000000000000000000000000000000000..d464d51840f2f521432dc9e9cad8eab601453da0
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pmc/pmc.c
@@ -0,0 +1,188 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "pmc.h"
+#include <board.h>
+#include <utility/assert.h>
+#include <utility/trace.h>
+
+#ifdef CP15_PRESENT
+#include <cp15/cp15.h>
+#endif
+
+#define MASK_STATUS 0x3FFFFFFC
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+#if defined(at91sam7l64) || defined(at91sam7l128)
+//------------------------------------------------------------------------------
+/// Sets the fast wake-up inputs that can get the device out of Wait mode.
+/// \param inputs  Fast wake-up inputs to enable.
+//------------------------------------------------------------------------------
+void PMC_SetFastWakeUpInputs(unsigned int inputs)
+{
+    SANITY_CHECK((inputs & ~0xFF) == 0);
+    AT91C_BASE_PMC->PMC_FSMR = inputs;
+}
+
+#if !defined(__ICCARM__)
+__attribute__ ((section (".ramfunc"))) // GCC
+#endif
+//------------------------------------------------------------------------------
+/// Disables the main oscillator, making the device enter Wait mode.
+//------------------------------------------------------------------------------
+void PMC_DisableMainOscillatorForWaitMode(void)
+{
+    AT91C_BASE_PMC->PMC_MOR = 0x37 << 16;
+    while ((AT91C_BASE_PMC->PMC_MOR & AT91C_PMC_MAINSELS) != AT91C_PMC_MAINSELS);
+}
+
+#endif
+
+#if defined(at91sam7l)
+//------------------------------------------------------------------------------
+/// Disables the main oscillator when NOT running on it.
+//------------------------------------------------------------------------------
+void PMC_DisableMainOscillator(void)
+{
+    AT91C_BASE_PMC->PMC_MOR = 0x37 << 16;
+    while ((AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MAINSELS) == AT91C_PMC_MAINSELS);
+}
+#endif
+
+//------------------------------------------------------------------------------
+/// Disables the processor clock
+//------------------------------------------------------------------------------
+void PMC_DisableProcessorClock(void)
+{    
+    AT91C_BASE_PMC->PMC_SCDR = AT91C_PMC_PCK;   
+    while ((AT91C_BASE_PMC->PMC_SCSR & AT91C_PMC_PCK) != AT91C_PMC_PCK); 
+}
+
+//------------------------------------------------------------------------------
+/// Enables the clock of a peripheral. The peripheral ID (AT91C_ID_xxx) is used
+/// to identify which peripheral is targetted.
+/// Note that the ID must NOT be shifted (i.e. 1 << AT91C_ID_xxx).
+/// \param id  Peripheral ID (AT91C_ID_xxx).
+//------------------------------------------------------------------------------
+void PMC_EnablePeripheral(unsigned int id)
+{
+    SANITY_CHECK(id < 32);
+
+    if ((AT91C_BASE_PMC->PMC_PCSR & (1 << id)) == (1 << id)) {
+
+        TRACE_INFO("PMC_EnablePeripheral: clock of peripheral"
+                   " %u is already enabled\n\r",
+                   id);
+    }
+    else {
+
+        AT91C_BASE_PMC->PMC_PCER = 1 << id;
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Disables the clock of a peripheral. The peripheral ID (AT91C_ID_xxx) is used
+/// to identify which peripheral is targetted.
+/// Note that the ID must NOT be shifted (i.e. 1 << AT91C_ID_xxx).
+/// \param id  Peripheral ID (AT91C_ID_xxx).
+//------------------------------------------------------------------------------
+void PMC_DisablePeripheral(unsigned int id)
+{
+    SANITY_CHECK(id < 32);
+
+    if ((AT91C_BASE_PMC->PMC_PCSR & (1 << id)) != (1 << id)) {
+
+        TRACE_INFO("PMC_DisablePeripheral: clock of peripheral"
+                   " %u is not enabled\n\r",
+                   id);
+    }
+    else {
+
+        AT91C_BASE_PMC->PMC_PCDR = 1 << id;
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Enable all the periph clock via PMC
+/// (Becareful of the last 2 bits, it is not periph clock)
+//------------------------------------------------------------------------------
+void PMC_EnableAllPeripherals(void)
+{
+    AT91C_BASE_PMC->PMC_PCER = MASK_STATUS;
+    while( (AT91C_BASE_PMC->PMC_PCSR & MASK_STATUS) != MASK_STATUS);
+    TRACE_INFO("Enable all periph clocks\n\r"); 
+}
+
+//------------------------------------------------------------------------------
+/// Disable all the periph clock via PMC
+/// (Becareful of the last 2 bits, it is not periph clock)
+//------------------------------------------------------------------------------
+void PMC_DisableAllPeripherals(void)
+{
+    AT91C_BASE_PMC->PMC_PCDR = MASK_STATUS;
+    while((AT91C_BASE_PMC->PMC_PCSR & MASK_STATUS) != 0);
+    TRACE_INFO("Disable all periph clocks\n\r");
+}
+
+//-----------------------------------------------------------------------------
+/// Get Periph Status
+//-----------------------------------------------------------------------------
+unsigned int PMC_IsAllPeriphEnabled(void)
+{
+    return (AT91C_BASE_PMC->PMC_PCSR == MASK_STATUS);
+}
+
+//-----------------------------------------------------------------------------
+/// Get Periph Status
+//-----------------------------------------------------------------------------
+unsigned int PMC_IsPeriphEnabled(unsigned int id)
+{
+    return (AT91C_BASE_PMC->PMC_PCSR & (1 << id));  
+}
+//------------------------------------------------------------------------------
+/// Put the CPU in Idle Mode for lower consumption
+//------------------------------------------------------------------------------
+void PMC_CPUInIdleMode(void)
+{
+#ifndef CP15_PRESENT	
+    PMC_DisableProcessorClock();
+#else
+    AT91C_BASE_PMC->PMC_SCDR = AT91C_PMC_PCK; 
+    CP15_WaitForInterrupt();
+#endif
+}
+
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/pmc/pmc.h b/usb-loader/samba_applets/at91lib/peripherals/pmc/pmc.h
new file mode 100644
index 0000000000000000000000000000000000000000..a53b36561284335fcc4b77fbbc472c55418ef052
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/pmc/pmc.h
@@ -0,0 +1,62 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+#ifndef PMC_H
+#define PMC_H
+
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+#if defined(at91sam7l64) || defined(at91sam7l128)
+extern void PMC_SetFastWakeUpInputs(unsigned int inputs);
+extern void PMC_DisableMainOscillator(void);
+extern
+#ifdef __ICCARM__
+__ramfunc
+#endif //__ICCARM__
+void PMC_DisableMainOscillatorForWaitMode(void);
+#endif // at91sam7l64 at91sam7l128
+
+extern void PMC_DisableProcessorClock(void);
+extern void PMC_EnablePeripheral(unsigned int id);
+extern void PMC_DisablePeripheral(unsigned int id);
+extern void PMC_CPUInIdleMode(void);
+
+
+extern void PMC_EnableAllPeripherals(void);
+
+extern void PMC_DisableAllPeripherals(void);
+
+extern unsigned int PMC_IsAllPeriphEnabled(void);
+
+extern unsigned int PMC_IsPeriphEnabled(unsigned int id);
+
+#endif //#ifndef PMC_H
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/spi/spi.c b/usb-loader/samba_applets/at91lib/peripherals/spi/spi.c
new file mode 100644
index 0000000000000000000000000000000000000000..16eba7101013a4c953b25273271304eb9f61bce9
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/spi/spi.c
@@ -0,0 +1,194 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "spi.h"
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+/// Enables a SPI peripheral
+/// \param spi  Pointer to an AT91S_SPI instance.
+//------------------------------------------------------------------------------
+void SPI_Enable(AT91S_SPI *spi)
+{
+    spi->SPI_CR = AT91C_SPI_SPIEN;
+}
+
+//------------------------------------------------------------------------------
+/// Disables a SPI peripheral.
+/// \param spi  Pointer to an AT91S_SPI instance.
+//------------------------------------------------------------------------------
+void SPI_Disable(AT91S_SPI *spi)
+{
+    spi->SPI_CR = AT91C_SPI_SPIDIS;
+}
+
+//------------------------------------------------------------------------------
+/// Configures a SPI peripheral as specified. The configuration can be computed
+/// using several macros (see "SPI configuration macros") and the constants
+/// defined in LibV3 (AT91C_SPI_*).
+/// \param spi  Pointer to an AT91S_SPI instance.
+/// \param id  Peripheral ID of the SPI.
+/// \param configuration  Value of the SPI configuration register.
+//------------------------------------------------------------------------------
+void SPI_Configure(AT91S_SPI *spi,
+                          unsigned int id,
+                          unsigned int configuration)
+{
+    AT91C_BASE_PMC->PMC_PCER = 1 << id;
+    spi->SPI_CR = AT91C_SPI_SPIDIS;
+    // Execute a software reset of the SPI twice
+    spi->SPI_CR = AT91C_SPI_SWRST;
+    spi->SPI_CR = AT91C_SPI_SWRST;
+    spi->SPI_MR = configuration;
+}
+
+//------------------------------------------------------------------------------
+/// Configures a chip select of a SPI peripheral. The chip select configuration
+/// is computed using the definition provided by the LibV3 (AT91C_SPI_*).
+/// \param spi  Pointer to an AT91S_SPI instance.
+/// \param npcs  Chip select to configure (1, 2, 3 or 4).
+/// \param configuration  Desired chip select configuration.
+//------------------------------------------------------------------------------
+void SPI_ConfigureNPCS(AT91S_SPI *spi,
+                              unsigned int npcs,
+                              unsigned int configuration)
+{
+    spi->SPI_CSR[npcs] = configuration;
+}
+
+//------------------------------------------------------------------------------
+/// Sends data through a SPI peripheral. If the SPI is configured to use a fixed
+/// peripheral select, the npcs value is meaningless. Otherwise, it identifies
+/// the component which shall be addressed.
+/// \param spi  Pointer to an AT91S_SPI instance.
+/// \param npcs  Chip select of the component to address (1, 2, 3 or 4).
+/// \param data  Word of data to send.
+//------------------------------------------------------------------------------
+void SPI_Write(AT91S_SPI *spi, unsigned int npcs, unsigned short data)
+{
+    // Discard contents of RDR register
+    //volatile unsigned int discard = spi->SPI_RDR;
+
+    // Send data
+    while ((spi->SPI_SR & AT91C_SPI_TXEMPTY) == 0);
+    spi->SPI_TDR = data | SPI_PCS(npcs);
+    while ((spi->SPI_SR & AT91C_SPI_TDRE) == 0);
+}
+
+//------------------------------------------------------------------------------
+/// Sends the contents of buffer through a SPI peripheral, using the PDC to
+/// take care of the transfer.
+/// \param spi  Pointer to an AT91S_SPI instance.
+/// \param buffer  Data buffer to send.
+/// \param length  Length of the data buffer.
+//------------------------------------------------------------------------------
+unsigned char SPI_WriteBuffer(AT91S_SPI *spi,
+                                     void *buffer,
+                                     unsigned int length)
+{
+#if !defined(CHIP_SPI_DMA)
+    // Check if first bank is free
+    if (spi->SPI_TCR == 0) {
+
+        spi->SPI_TPR = (unsigned int) buffer;
+        spi->SPI_TCR = length;
+        spi->SPI_PTCR = AT91C_PDC_TXTEN;
+        return 1;
+    }
+    // Check if second bank is free
+    else if (spi->SPI_TNCR == 0) {
+
+        spi->SPI_TNPR = (unsigned int) buffer;
+        spi->SPI_TNCR = length;
+        return 1;
+    }
+#endif      
+    // No free banks
+    return 0;
+}
+
+//------------------------------------------------------------------------------
+/// Returns 1 if there is no pending write operation on the SPI; otherwise
+/// returns 0.
+/// \param pSpi  Pointer to an AT91S_SPI instance.
+//------------------------------------------------------------------------------
+unsigned char SPI_IsFinished(AT91S_SPI *pSpi)
+{
+    return ((pSpi->SPI_SR & AT91C_SPI_TXEMPTY) != 0);
+}
+
+//------------------------------------------------------------------------------
+/// Reads and returns the last word of data received by a SPI peripheral. This
+/// method must be called after a successful SPI_Write call.
+/// \param spi  Pointer to an AT91S_SPI instance.
+//------------------------------------------------------------------------------
+unsigned short SPI_Read(AT91S_SPI *spi)
+{
+    while ((spi->SPI_SR & AT91C_SPI_RDRF) == 0);
+    return spi->SPI_RDR & 0xFFFF;
+}
+
+//------------------------------------------------------------------------------
+/// Reads data from a SPI peripheral until the provided buffer is filled. This
+/// method does NOT need to be called after SPI_Write or SPI_WriteBuffer.
+/// \param spi  Pointer to an AT91S_SPI instance.
+/// \param buffer  Data buffer to store incoming bytes.
+/// \param length  Length in bytes of the data buffer.
+//------------------------------------------------------------------------------
+unsigned char SPI_ReadBuffer(AT91S_SPI *spi,
+                                    void *buffer,
+                                    unsigned int length)
+{
+#if !defined(CHIP_SPI_DMA)
+    // Check if the first bank is free
+    if (spi->SPI_RCR == 0) {
+
+        spi->SPI_RPR = (unsigned int) buffer;
+        spi->SPI_RCR = length;
+        spi->SPI_PTCR = AT91C_PDC_RXTEN;
+        return 1;
+    }
+    // Check if second bank is free
+    else if (spi->SPI_RNCR == 0) {
+
+        spi->SPI_RNPR = (unsigned int) buffer;
+        spi->SPI_RNCR = length;
+        return 1;
+    }
+#endif
+    // No free bank
+    return 0;
+}
+
diff --git a/usb-loader/samba_applets/at91lib/peripherals/spi/spi.h b/usb-loader/samba_applets/at91lib/peripherals/spi/spi.h
new file mode 100644
index 0000000000000000000000000000000000000000..f4e255770be89e320625a7d8babedcbce367b7cc
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/peripherals/spi/spi.h
@@ -0,0 +1,114 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+/// !Purpose
+/// 
+/// Definitions for SPI peripheral usage.
+///
+/// !Usage
+///
+/// -# Enable the SPI pins required by the application (see pio.h).
+/// -# Configure the SPI using the SPI_Configure function. This enables the
+///    peripheral clock. The mode register is loaded with the given value.
+/// -# Configure all the necessary chip selects with SPI_ConfigureNPCS.
+/// -# Enable the SPI by calling SPI_Enable.
+/// -# Send/receive data using SPI_Write and SPI_Read. Note that SPI_Read
+///    must be called after SPI_Write to retrieve the last value read.
+/// -# Send/receive data using the PDC with the SPI_WriteBuffer and
+///    SPI_ReadBuffer functions.
+/// -# Disable the SPI by calling SPI_Disable.
+//------------------------------------------------------------------------------
+
+#ifndef SPI_H
+#define SPI_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// \page "SPI configuration macros"
+/// This page lists several macros which should be used when configuring a SPI
+/// peripheral.
+/// 
+/// !Macros
+/// - SPI_PCS
+/// - SPI_SCBR
+/// - SPI_DLYBS
+/// - SPI_DLYBCT
+
+/// Calculate the PCS field value given the chip select NPCS value
+#define SPI_PCS(npcs)       ((~(1 << npcs) & 0xF) << 16)
+
+/// Calculates the value of the CSR SCBR field given the baudrate and MCK.
+#define SPI_SCBR(baudrate, masterClock) \
+            ((unsigned int) (masterClock / baudrate) << 8)
+
+/// Calculates the value of the CSR DLYBS field given the desired delay (in ns)
+#define SPI_DLYBS(delay, masterClock) \
+            ((unsigned int) (((masterClock / 1000000) * delay) / 1000) << 16)
+
+/// Calculates the value of the CSR DLYBCT field given the desired delay (in ns)
+#define SPI_DLYBCT(delay, masterClock) \
+            ((unsigned int) (((masterClock / 1000000) * delay) / 32000) << 24)
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+extern void SPI_Enable(AT91S_SPI *spi);
+extern void SPI_Disable(AT91S_SPI *spi);
+extern void SPI_Configure(AT91S_SPI *spi,
+                                 unsigned int id,
+                                 unsigned int configuration);
+extern void SPI_ConfigureNPCS(AT91S_SPI *spi,
+                                     unsigned int npcs,
+                                     unsigned int configuration);
+extern void SPI_Write(AT91S_SPI *spi, unsigned int npcs, unsigned short data);
+extern unsigned char SPI_WriteBuffer(AT91S_SPI *spi,
+                                            void *buffer,
+                                            unsigned int length);
+
+extern unsigned char SPI_IsFinished(AT91S_SPI *pSpi);
+
+extern unsigned short SPI_Read(AT91S_SPI *spi);
+extern unsigned char SPI_ReadBuffer(AT91S_SPI *spi,
+                                           void *buffer,
+                                           unsigned int length);
+
+#endif //#ifndef SPI_H
+
diff --git a/usb-loader/samba_applets/at91lib/utility/assert.h b/usb-loader/samba_applets/at91lib/utility/assert.h
new file mode 100644
index 0000000000000000000000000000000000000000..5cccb619377bde67baee9d8ae4b9096a98470532
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/assert.h
@@ -0,0 +1,114 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+///
+/// Definition of the ASSERT() and SANITY_CHECK() macros, which are used for
+/// runtime condition & parameter verifying.
+///
+/// !Usage
+///
+/// -# Use ASSERT() in your code to check the value of function parameters,
+///    return values, etc. *Warning:* the ASSERT() condition must not have
+///    any side-effect; otherwise, the program may not work properly
+///    anymore when assertions are disabled.
+/// -# Use SANITY_CHECK() to perform checks with a default error message
+///    (outputs the file and line number where the error occured). This 
+///    reduces memory overhead caused by assertion error strings.
+/// -# Initialize the dbgu to see failed assertions at run-time.
+/// -# Assertions can be entirely disabled by defining the NOASSERT symbol
+///    at compilation time.
+//------------------------------------------------------------------------------
+
+#ifndef ASSERT_H
+#define ASSERT_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <stdio.h>
+#include "trace.h"
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+#if defined(NOASSERT)
+    #define ASSERT(...)
+    #define SANITY_CHECK(...)
+#else
+
+    #if (TRACE_LEVEL == 0)
+        /// Checks that the given condition is true, 
+        /// otherwise stops the program execution.
+        /// \param condition  Condition to verify.
+        #define ASSERT(condition, ...)  { \
+            if (!(condition)) { \
+                while (1); \
+            } \
+        }
+
+        /// Performs the same duty as the ASSERT() macro
+        /// \param condition  Condition to verify.
+        #define SANITY_CHECK(condition) ASSERT(condition, ...)
+
+    #else
+        /// Checks that the given condition is true, otherwise displays an error
+        /// message and stops the program execution.
+        /// \param condition  Condition to verify.
+        #define ASSERT(condition, ...)  { \
+            if (!(condition)) { \
+                printf("-F- ASSERT: "); \
+                printf(__VA_ARGS__); \
+                while (1); \
+            } \
+        }
+        #define SANITY_ERROR            "Sanity check failed at %s:%d\n\r"
+    
+        /// Performs the same duty as the ASSERT() macro, except a default error
+        /// message is output if the condition is false.
+        /// \param condition  Condition to verify.
+        #define SANITY_CHECK(condition) ASSERT(condition, SANITY_ERROR, __FILE__, __LINE__)
+    #endif
+#endif
+
+
+
+
+
+
+
+
+
+
+#endif //#ifndef ASSERT_H
+
diff --git a/usb-loader/samba_applets/at91lib/utility/math.c b/usb-loader/samba_applets/at91lib/utility/math.c
new file mode 100644
index 0000000000000000000000000000000000000000..601238531d1be38ad9e81f7f159bc2873b95d756
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/math.c
@@ -0,0 +1,91 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "math.h"
+#include "trace.h"
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Returns the minimum value between two integers.
+/// \param a  First integer to compare.
+/// \param b  Second integer to compare.
+//------------------------------------------------------------------------------
+unsigned int min(unsigned int a, unsigned int b)
+{ 
+    if (a < b) {
+
+        return a;
+    }
+    else {
+
+        return b;
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Returns the absolute value of an integer.
+/// \param value  Integer value.
+//------------------------------------------------------------------------------
+// Do not call this function "abs", problem with gcc !
+unsigned int absv(signed int value)
+{
+    if (value < 0) {
+
+        return -value;
+    }
+    else {
+
+        return value;
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Computes and returns x power of y.
+/// \param x  Value.
+/// \param y  Power.
+//------------------------------------------------------------------------------
+unsigned int power(unsigned int x, unsigned int y)
+{
+    unsigned int result = 1;
+    
+    while (y > 0) {
+
+        result *= x;
+        y--;
+    } 
+    return result;
+}
+
diff --git a/usb-loader/samba_applets/at91lib/utility/math.h b/usb-loader/samba_applets/at91lib/utility/math.h
new file mode 100644
index 0000000000000000000000000000000000000000..7e1c486da018413c761b71d30e65ac5b5dbcb1e1
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/math.h
@@ -0,0 +1,41 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+#ifndef MATH_H
+#define MATH_H
+
+//------------------------------------------------------------------------------
+//         Exported functions
+//------------------------------------------------------------------------------
+
+extern unsigned int min(unsigned int a, unsigned int b);
+extern unsigned int absv(signed int value);
+extern unsigned int power(unsigned int x, unsigned int y);
+#endif //#ifndef MATH_H
+
diff --git a/usb-loader/samba_applets/at91lib/utility/retarget.c b/usb-loader/samba_applets/at91lib/utility/retarget.c
new file mode 100644
index 0000000000000000000000000000000000000000..8f81ba6d335b9f06a9bff2d6abf906062970e483
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/retarget.c
@@ -0,0 +1,88 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+///
+/// This file Configures the target-dependent low level functions for character I/O.
+///
+/// !Contents
+/// The code implement the lower-level functions as follows:
+///    - fputc
+///    - ferror
+///    - _ttywrch
+///    - _sys_exit
+///
+///
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+#include <dbgu/dbgu.h>
+#include <stdio.h>
+
+// Disable semihosting
+#pragma import(__use_no_semihosting_swi) 
+
+struct __FILE { int handle;} ;
+FILE __stdout;
+FILE __stderr;
+
+//------------------------------------------------------------------------------
+///  Outputs a character to a file.
+//------------------------------------------------------------------------------
+int fputc(int ch, FILE *f) {
+    if ((f == stdout) || (f == stderr)) {
+        DBGU_PutChar(ch);
+        return ch;
+    }
+    else {
+        return EOF;
+    }
+}
+
+//------------------------------------------------------------------------------
+///  Returns the error status accumulated during file I/O.
+//------------------------------------------------------------------------------
+int ferror(FILE *f) {
+    return EOF;
+}
+
+
+void _ttywrch(int ch) {
+    DBGU_PutChar((unsigned char)ch);
+}
+
+
+void _sys_exit(int return_code) {
+    label:  goto label;  /* endless loop */
+}
diff --git a/usb-loader/samba_applets/at91lib/utility/stdio.c b/usb-loader/samba_applets/at91lib/utility/stdio.c
new file mode 100644
index 0000000000000000000000000000000000000000..3e76ddc202431049af6b7fb3b397d213083fda32
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/stdio.c
@@ -0,0 +1,512 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+///
+/// Implementation of several stdio.h methods, such as printf(), sprintf() and
+/// so on. This reduces the memory footprint of the binary when using those
+/// methods, compared to the libc implementation.
+///
+/// !Usage
+///
+/// Adds stdio.c to the list of file to compile for the project. This will
+/// automatically replace libc methods by the custom ones.
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <stdio.h>
+#include <stdarg.h>
+
+//------------------------------------------------------------------------------
+//         Local Definitions
+//------------------------------------------------------------------------------
+
+// Maximum string size allowed (in bytes).
+#define MAX_STRING_SIZE         100
+
+//------------------------------------------------------------------------------
+//         Global Variables
+//------------------------------------------------------------------------------
+
+// Required for proper compilation.
+struct _reent r = {0, (FILE *) 0, (FILE *) 1, (FILE *) 0};
+struct _reent *_impure_ptr = &r;
+
+//------------------------------------------------------------------------------
+//         Local Functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+// Writes a character inside the given string. Returns 1.
+// \param pStr  Storage string.
+// \param c  Character to write.
+//------------------------------------------------------------------------------
+signed int PutChar(char *pStr, char c)
+{
+    *pStr = c;
+    return 1;
+}
+
+//------------------------------------------------------------------------------
+// Writes a string inside the given string.
+// Returns the size of the written
+// string.
+// \param pStr  Storage string.
+// \param pSource  Source string.
+//------------------------------------------------------------------------------
+signed int PutString(char *pStr, const char *pSource)
+{
+    signed int num = 0;
+
+    while (*pSource != 0) {
+
+        *pStr++ = *pSource++;
+        num++;
+    }
+
+    return num;
+}
+
+//------------------------------------------------------------------------------
+// Writes an unsigned int inside the given string, using the provided fill &
+// width parameters.
+// Returns the size in characters of the written integer.
+// \param pStr  Storage string.
+// \param fill  Fill character.
+// \param width  Minimum integer width.
+// \param value  Integer value.
+//------------------------------------------------------------------------------
+signed int PutUnsignedInt(
+    char *pStr,
+    char fill,
+    signed int width,
+    unsigned int value)
+{
+    signed int num = 0;
+
+    // Take current digit into account when calculating width
+    width--;
+
+    // Recursively write upper digits
+    if ((value / 10) > 0) {
+
+        num = PutUnsignedInt(pStr, fill, width, value / 10);
+        pStr += num;
+    }
+    // Write filler characters
+    else {
+
+        while (width > 0) {
+
+            PutChar(pStr, fill);
+            pStr++;
+            num++;
+            width--;
+        }
+    }
+
+    // Write lower digit
+    num += PutChar(pStr, (value % 10) + '0');
+
+    return num;
+}
+
+//------------------------------------------------------------------------------
+// Writes a signed int inside the given string, using the provided fill & width
+// parameters.
+// Returns the size of the written integer.
+// \param pStr  Storage string.
+// \param fill  Fill character.
+// \param width  Minimum integer width.
+// \param value  Signed integer value.
+//------------------------------------------------------------------------------
+signed int PutSignedInt(
+    char *pStr,
+    char fill,
+    signed int width,
+    signed int value)
+{
+    signed int num = 0;
+    unsigned int absolute;
+
+    // Compute absolute value
+    if (value < 0) {
+
+        absolute = -value;
+    }
+    else {
+
+        absolute = value;
+    }
+
+    // Take current digit into account when calculating width
+    width--;
+
+    // Recursively write upper digits
+    if ((absolute / 10) > 0) {
+
+        if (value < 0) {
+        
+            num = PutSignedInt(pStr, fill, width, -(absolute / 10));
+        }
+        else {
+
+            num = PutSignedInt(pStr, fill, width, absolute / 10);
+        }
+        pStr += num;
+    }
+    else {
+
+        // Reserve space for sign
+        if (value < 0) {
+
+            width--;
+        }
+
+        // Write filler characters
+        while (width > 0) {
+
+            PutChar(pStr, fill);
+            pStr++;
+            num++;
+            width--;
+        }
+
+        // Write sign
+        if (value < 0) {
+
+            num += PutChar(pStr, '-');
+            pStr++;
+        }
+    }
+
+    // Write lower digit
+    num += PutChar(pStr, (absolute % 10) + '0');
+
+    return num;
+}
+
+//------------------------------------------------------------------------------
+// Writes an hexadecimal value into a string, using the given fill, width &
+// capital parameters.
+// Returns the number of char written.
+// \param pStr  Storage string.
+// \param fill  Fill character.
+// \param width  Minimum integer width.
+// \param maj  Indicates if the letters must be printed in lower- or upper-case.
+// \param value  Hexadecimal value.
+//------------------------------------------------------------------------------
+signed int PutHexa(
+    char *pStr,
+    char fill,
+    signed int width,
+    unsigned char maj,
+    unsigned int value)
+{
+    signed int num = 0;
+
+    // Decrement width
+    width--;
+
+    // Recursively output upper digits
+    if ((value >> 4) > 0) {
+
+        num += PutHexa(pStr, fill, width, maj, value >> 4);
+        pStr += num;
+    }
+    // Write filler chars
+    else {
+
+        while (width > 0) {
+
+            PutChar(pStr, fill);
+            pStr++;
+            num++;
+            width--;
+        }
+    }
+
+    // Write current digit
+    if ((value & 0xF) < 10) {
+
+        PutChar(pStr, (value & 0xF) + '0');
+    }
+    else if (maj) {
+
+        PutChar(pStr, (value & 0xF) - 10 + 'A');
+    }
+    else {
+
+        PutChar(pStr, (value & 0xF) - 10 + 'a');
+    }
+    num++;
+
+    return num;
+}
+
+//------------------------------------------------------------------------------
+//         Global Functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Stores the result of a formatted string into another string. Format
+/// arguments are given in a va_list instance.
+/// Return the number of characters written.
+/// \param pStr    Destination string.
+/// \param length  Length of Destination string.
+/// \param pFormat Format string.
+/// \param ap      Argument list.
+//------------------------------------------------------------------------------
+signed int vsnprintf(char *pStr, size_t length, const char *pFormat, va_list ap)
+{
+    char          fill;
+    unsigned char width;
+    signed int    num = 0;
+    signed int    size = 0;
+
+    // Clear the string
+    if (pStr) {
+
+        *pStr = 0;
+    }
+
+    // Phase string
+    while (*pFormat != 0 && size < length) {
+
+        // Normal character
+        if (*pFormat != '%') {
+
+            *pStr++ = *pFormat++;
+            size++;
+        }
+        // Escaped '%'
+        else if (*(pFormat+1) == '%') {
+
+            *pStr++ = '%';
+            pFormat += 2;
+            size++;
+        }
+        // Token delimiter
+        else {
+
+            fill = ' ';
+            width = 0;
+            pFormat++;
+
+            // Parse filler
+            if (*pFormat == '0') {
+
+                fill = '0';
+                pFormat++;
+            }
+
+            // Parse width
+            while ((*pFormat >= '0') && (*pFormat <= '9')) {
+        
+                width = (width*10) + *pFormat-'0';
+                pFormat++;
+            }
+
+            // Check if there is enough space
+            if (size + width > length) {
+
+                width = length - size;
+            }
+        
+            // Parse type
+            switch (*pFormat) {
+            case 'd': 
+            case 'i': num = PutSignedInt(pStr, fill, width, va_arg(ap, signed int)); break;
+            case 'u': num = PutUnsignedInt(pStr, fill, width, va_arg(ap, unsigned int)); break;
+            case 'x': num = PutHexa(pStr, fill, width, 0, va_arg(ap, unsigned int)); break;
+            case 'X': num = PutHexa(pStr, fill, width, 1, va_arg(ap, unsigned int)); break;
+            case 's': num = PutString(pStr, va_arg(ap, char *)); break;
+            case 'c': num = PutChar(pStr, va_arg(ap, unsigned int)); break;
+            default:
+                return EOF;
+            }
+
+            pFormat++;
+            pStr += num;
+            size += num;
+        }
+    }
+
+    // NULL-terminated (final \0 is not counted)
+    if (size < length) {
+
+        *pStr = 0;
+    }
+    else {
+
+        *(--pStr) = 0;
+        size--;
+    }
+
+    return size;
+}
+
+//------------------------------------------------------------------------------
+/// Stores the result of a formatted string into another string. Format
+/// arguments are given in a va_list instance.
+/// Return the number of characters written.
+/// \param pString Destination string.
+/// \param length  Length of Destination string.
+/// \param pFormat Format string.
+/// \param ...     Other arguments
+//------------------------------------------------------------------------------
+signed int snprintf(char *pString, size_t length, const char *pFormat, ...)
+{
+    va_list    ap;
+    signed int rc;
+
+    va_start(ap, pFormat);
+    rc = vsnprintf(pString, length, pFormat, ap);
+    va_end(ap);
+
+    return rc;
+}
+
+//------------------------------------------------------------------------------
+/// Stores the result of a formatted string into another string. Format
+/// arguments are given in a va_list instance.
+/// Return the number of characters written.
+/// \param pString  Destination string.
+/// \param pFormat  Format string.
+/// \param ap       Argument list.
+//------------------------------------------------------------------------------
+signed int vsprintf(char *pString, const char *pFormat, va_list ap)
+{
+    return vsnprintf(pString, MAX_STRING_SIZE, pFormat, ap);
+}
+
+//------------------------------------------------------------------------------
+/// Outputs a formatted string on the given stream. Format arguments are given
+/// in a va_list instance.
+/// \param pStream  Output stream.
+/// \param pFormat  Format string
+/// \param ap  Argument list.
+//------------------------------------------------------------------------------
+signed int vfprintf(FILE *pStream, const char *pFormat, va_list ap)
+{
+    char pStr[MAX_STRING_SIZE];
+    char pError[] = "stdio.c: increase MAX_STRING_SIZE\n\r";
+
+    // Write formatted string in buffer
+    if (vsprintf(pStr, pFormat, ap) >= MAX_STRING_SIZE) {
+
+        fputs(pError, stderr);
+        while (1); // Increase MAX_STRING_SIZE
+    }
+
+    // Display string
+    return fputs(pStr, pStream);
+}
+
+//------------------------------------------------------------------------------
+/// Outputs a formatted string on the DBGU stream. Format arguments are given
+/// in a va_list instance.
+/// \param pFormat  Format string
+/// \param ap  Argument list.
+//------------------------------------------------------------------------------
+signed int vprintf(const char *pFormat, va_list ap)
+{
+    return vfprintf(stdout, pFormat, ap);
+}
+
+//------------------------------------------------------------------------------
+/// Outputs a formatted string on the given stream, using a variable number of
+/// arguments.
+/// \param pStream  Output stream.
+/// \param pFormat  Format string.
+//------------------------------------------------------------------------------
+signed int fprintf(FILE *pStream, const char *pFormat, ...)
+{
+    va_list ap;
+    signed int result;
+
+    // Forward call to vfprintf
+    va_start(ap, pFormat);
+    result = vfprintf(pStream, pFormat, ap);
+    va_end(ap);
+
+    return result;
+}
+
+//------------------------------------------------------------------------------
+/// Outputs a formatted string on the DBGU stream, using a variable number of
+/// arguments.
+/// \param pFormat  Format string.
+//------------------------------------------------------------------------------
+signed int printf(const char *pFormat, ...)
+{
+    va_list ap;
+    signed int result;
+
+    // Forward call to vprintf
+    va_start(ap, pFormat);
+    result = vprintf(pFormat, ap);
+    va_end(ap);
+
+    return result;
+}
+
+//------------------------------------------------------------------------------
+/// Writes a formatted string inside another string.
+/// \param pStr  Storage string.
+/// \param pFormat  Format string.
+//------------------------------------------------------------------------------
+signed int sprintf(char *pStr, const char *pFormat, ...)
+{
+    va_list ap;
+    signed int result;
+
+    // Forward call to vsprintf
+    va_start(ap, pFormat);
+    result = vsprintf(pStr, pFormat, ap);
+    va_end(ap);
+
+    return result;
+}
+
+//------------------------------------------------------------------------------
+/// Outputs a string on stdout.
+/// \param pStr  String to output.
+//------------------------------------------------------------------------------
+signed int puts(const char *pStr)
+{
+    return fputs(pStr, stdout);
+}
+
diff --git a/usb-loader/samba_applets/at91lib/utility/trace.c b/usb-loader/samba_applets/at91lib/utility/trace.c
new file mode 100644
index 0000000000000000000000000000000000000000..4d4a5af9dee21d7549610d6e39f5e8555d2ba452
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/trace.c
@@ -0,0 +1,299 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "trace.h"
+
+//------------------------------------------------------------------------------
+//         Internal variables
+//------------------------------------------------------------------------------
+
+/// Trace level can be set at applet initialization
+#if !defined(NOTRACE) && (DYN_TRACES == 1)
+    unsigned int traceLevel = TRACE_LEVEL;
+#endif
+  
+#ifndef NOFPUT
+#include <stdio.h>
+#include <stdarg.h>
+
+//------------------------------------------------------------------------------
+/// \exclude
+/// Implementation of fputc using the DBGU as the standard output. Required
+/// for printf().
+/// \param c  Character to write.
+/// \param pStream  Output stream.
+/// \param The character written if successful, or -1 if the output stream is
+/// not stdout or stderr.
+//------------------------------------------------------------------------------
+signed int fputc(signed int c, FILE *pStream)
+{
+    if ((pStream == stdout) || (pStream == stderr)) {
+
+        TRACE_PutChar(c);
+        return c;
+    }
+    else {
+
+        return EOF;
+    }
+}
+
+//------------------------------------------------------------------------------
+/// \exclude
+/// Implementation of fputs using the DBGU as the standard output. Required
+/// for printf(). Does NOT currently use the PDC.
+/// \param pStr  String to write.
+/// \param pStream  Output stream.
+/// \return Number of characters written if successful, or -1 if the output
+/// stream is not stdout or stderr.
+//------------------------------------------------------------------------------
+signed int fputs(const char *pStr, FILE *pStream)
+{
+    signed int num = 0;
+
+    while (*pStr != 0) {
+
+        if (fputc(*pStr, pStream) == -1) {
+
+            return -1;
+        }
+        num++;
+        pStr++;
+    }
+
+    return num;
+}
+
+#undef putchar
+
+//------------------------------------------------------------------------------
+/// \exclude
+/// Outputs a character on the DBGU.
+/// \param c  Character to output.
+/// \return The character that was output.
+//------------------------------------------------------------------------------
+signed int putchar(signed int c)
+{
+    return fputc(c, stdout);
+}
+
+#endif //#ifndef NOFPUT
+
+//------------------------------------------------------------------------------
+//         Local Functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Print char if printable. If not print a point
+/// \param c char to
+//------------------------------------------------------------------------------
+static void PrintChar(unsigned char c)
+{
+    if( (/*c >= 0x00 &&*/ c <= 0x1F) ||
+        (c >= 0xB0 && c <= 0xDF) ) {
+
+       printf(".");
+    }
+    else {
+
+       printf("%c", c);
+    }
+}
+
+//------------------------------------------------------------------------------
+//         Global Functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Displays the content of the given frame on the Trace interface.
+/// \param pBuffer  Pointer to the frame to dump.
+/// \param size  Buffer size in bytes.
+//------------------------------------------------------------------------------
+void TRACE_DumpFrame(unsigned char *pFrame, unsigned int size)
+{
+    unsigned int i;
+
+    for (i=0; i < size; i++) {
+        printf("%02X ", pFrame[i]);
+    }
+
+    printf("\n\r");
+}
+
+//------------------------------------------------------------------------------
+/// Displays the content of the given buffer on the Trace interface.
+/// \param pBuffer  Pointer to the buffer to dump.
+/// \param size     Buffer size in bytes.
+/// \param address  Start address to display
+//------------------------------------------------------------------------------
+void TRACE_DumpMemory(
+    unsigned char *pBuffer,
+    unsigned int size,
+    unsigned int address
+    )
+{
+    unsigned int i, j;
+    unsigned int lastLineStart;
+    unsigned char* pTmp;
+
+    for (i=0; i < (size / 16); i++) {
+
+        printf("0x%08X: ", address + (i*16));
+        pTmp = (unsigned char*)&pBuffer[i*16];
+        for (j=0; j < 4; j++) {
+            printf("%02X%02X%02X%02X ", pTmp[0],pTmp[1],pTmp[2],pTmp[3]);
+            pTmp += 4;
+        }
+
+        pTmp = (unsigned char*)&pBuffer[i*16];
+        for (j=0; j < 16; j++) {
+            PrintChar(*pTmp++);
+        }
+
+        printf("\n\r");
+    }
+
+    if( (size%16) != 0) {
+        lastLineStart = size - (size%16);
+        printf("0x%08X: ", address + lastLineStart);
+
+        for (j= lastLineStart; j < lastLineStart+16; j++) {
+
+            if( (j!=lastLineStart) && (j%4 == 0) ) {
+                printf(" ");
+            }
+            if(j<size) {
+                printf("%02X", pBuffer[j]);
+            }
+            else {
+                printf("  ");
+            }
+        }
+
+        printf(" ");
+        for (j= lastLineStart; j <size; j++) {
+            PrintChar(pBuffer[j]);
+        }
+
+        printf("\n\r");
+    }
+}
+    
+//------------------------------------------------------------------------------
+/// Reads an integer
+//------------------------------------------------------------------------------
+unsigned char TRACE_GetInteger(unsigned int *pValue)
+{
+    unsigned char key;
+    unsigned char nbNb = 0;
+    unsigned int value = 0;
+    while(1) {
+        key = TRACE_GetChar();
+        TRACE_PutChar(key);
+        if(key >= '0' &&  key <= '9' ) {
+            value = (value * 10) + (key - '0');
+            nbNb++;
+        }
+        else if(key == 0x0D || key == ' ') {
+            if(nbNb == 0) {
+                printf("\n\rWrite a number and press ENTER or SPACE!\n\r");       
+                return 0; 
+            } else {
+                printf("\n\r"); 
+                *pValue = value;
+                return 1;
+            }
+        } else {
+            printf("\n\r'%c' not a number!\n\r", key);
+            return 0;  
+        }
+    }
+}
+
+//------------------------------------------------------------------------------
+/// Reads an integer and check the value
+//------------------------------------------------------------------------------
+unsigned char TRACE_GetIntegerMinMax(
+    unsigned int *pValue, 
+    unsigned int min, 
+    unsigned int max
+    )
+{
+    unsigned int value = 0;
+
+    if( TRACE_GetInteger(&value) == 0) {
+        return 0;
+    }
+    
+    if(value < min || value > max) {
+        printf("\n\rThe number have to be between %d and %d\n\r", min, max);
+        return 0; 
+    }
+
+    printf("\n\r"); 
+    *pValue = value;
+    return 1;
+}
+
+//------------------------------------------------------------------------------
+/// Reads an hexadecimal number
+//------------------------------------------------------------------------------
+unsigned char TRACE_GetHexa32(unsigned int *pValue)
+{
+    unsigned char key;
+    unsigned int i = 0;
+    unsigned int value = 0;
+    for(i = 0; i < 8; i++) {
+        key = TRACE_GetChar();
+        TRACE_PutChar(key);
+        if(key >= '0' &&  key <= '9' ) {
+            value = (value * 16) + (key - '0');
+        }
+        else if(key >= 'A' &&  key <= 'F' ) {
+            value = (value * 16) + (key - 'A' + 10) ;
+        }
+        else if(key >= 'a' &&  key <= 'f' ) {
+            value = (value * 16) + (key - 'a' + 10) ;
+        }        
+        else {
+            printf("\n\rIt is not a hexa character!\n\r");       
+            return 0; 
+        }
+    }
+
+    printf("\n\r");    
+    *pValue = value;     
+    return 1;
+}
+
diff --git a/usb-loader/samba_applets/at91lib/utility/trace.h b/usb-loader/samba_applets/at91lib/utility/trace.h
new file mode 100644
index 0000000000000000000000000000000000000000..dafc789627d7e49effb001509578fe5ba4faaaff
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/trace.h
@@ -0,0 +1,345 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \unit
+///
+/// !Purpose
+///
+/// Standard output methods for reporting debug information, warnings and
+/// errors, which can be easily be turned on/off.
+///
+/// !Usage
+/// -# Initialize the DBGU using TRACE_CONFIGURE() if you intend to eventually
+///    disable ALL traces; otherwise use DBGU_Configure().
+/// -# Uses the TRACE_DEBUG(), TRACE_INFO(), TRACE_WARNING(), TRACE_ERROR()
+///    TRACE_FATAL() macros to output traces throughout the program.
+/// -# Each type of trace has a level : Debug 5, Info 4, Warning 3, Error 2
+///    and Fatal 1. Disable a group of traces by changing the value of 
+///    TRACE_LEVEL during compilation; traces with a level bigger than TRACE_LEVEL 
+///    are not generated. To generate no trace, use the reserved value 0.
+/// -# Trace disabling can be static or dynamic. If dynamic disabling is selected
+///    the trace level can be modified in runtime. If static disabling is selected
+///    the disabled traces are not compiled.
+///
+/// !Trace level description
+/// -# TRACE_DEBUG (5): Traces whose only purpose is for debugging the program, 
+///    and which do not produce meaningful information otherwise.
+/// -# TRACE_INFO (4): Informational trace about the program execution. Should  
+///    enable the user to see the execution flow.
+/// -# TRACE_WARNING (3): Indicates that a minor error has happened. In most case
+///    it can be discarded safely; it may even be expected.
+/// -# TRACE_ERROR (2): Indicates an error which may not stop the program execution, 
+///    but which indicates there is a problem with the code.
+/// -# TRACE_FATAL (1): Indicates a major error which prevents the program from going
+///    any further.
+
+//------------------------------------------------------------------------------
+
+#ifndef TRACE_H
+#define TRACE_H
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include <board.h>
+#include <pio/pio.h>
+#include <stdio.h>
+
+// Select the trace interface
+// (add usart.o file in makefile if Usart interface is selected)
+#define TRACE_DBGU 1
+//#define TRACE_USART_0 1
+//#define TRACE_USART_1 1
+//#define TRACE_USART_2 1
+
+#if defined(TRACE_DBGU)
+#include <dbgu/dbgu.h>
+#else
+#include <usart/usart.h>
+#endif
+
+//------------------------------------------------------------------------------
+//         Global Definitions
+//------------------------------------------------------------------------------
+
+/// Softpack Version
+#define SOFTPACK_VERSION "1.7-rc1"
+
+#define TRACE_LEVEL_DEBUG      5
+#define TRACE_LEVEL_INFO       4
+#define TRACE_LEVEL_WARNING    3
+#define TRACE_LEVEL_ERROR      2
+#define TRACE_LEVEL_FATAL      1
+#define TRACE_LEVEL_NO_TRACE   0
+
+// By default, all traces are output except the debug one.
+#if !defined(TRACE_LEVEL)    
+#define TRACE_LEVEL TRACE_LEVEL_INFO
+#endif
+
+// By default, trace level is static (not dynamic)
+#if !defined(DYN_TRACES)
+#define DYN_TRACES 0
+#endif
+
+#if defined(NOTRACE)
+#error "Error: NOTRACE has to be not defined !"
+#endif
+
+#undef NOTRACE
+#if (DYN_TRACES==0)
+    #if (TRACE_LEVEL == TRACE_LEVEL_NO_TRACE)
+        #define NOTRACE
+    #endif
+#endif
+
+//------------------------------------------------------------------------------
+//         Global Macros
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Initializes the trace for normal project
+/// \param mode  DBGU mode.
+/// \param baudrate  DBGU baudrate.
+/// \param mck  Master clock frequency.
+//------------------------------------------------------------------------------
+#if defined(TRACE_DBGU)
+    #define TRACE_CONFIGURE(mode, baudrate, mck) { \
+        const Pin pinsDbgu[] = {PINS_DBGU}; \
+        PIO_Configure(pinsDbgu, PIO_LISTSIZE(pinsDbgu)); \
+        DBGU_Configure(mode, baudrate, mck); \
+    }
+#elif defined(TRACE_USART_0)
+    #define TRACE_CONFIGURE(mode, baudrate, mck) { \
+        const Pin pinsUsart[] = {PIN_USART0_TXD, PIN_USART0_RXD}; \
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_US0;\
+        AT91C_BASE_US0->US_IDR = 0xFFFFFFFF;\
+        PIO_Configure(pinsUsart, PIO_LISTSIZE(pinsUsart)); \
+        USART_Configure(AT91C_BASE_US0,USART_MODE_ASYNCHRONOUS, baudrate, mck); \
+        USART_SetTransmitterEnabled(AT91C_BASE_US0,1);\
+        USART_SetReceiverEnabled(AT91C_BASE_US0,1);\
+    }
+#elif defined(TRACE_USART_1)
+    #define TRACE_CONFIGURE(mode, baudrate, mck) { \
+        const Pin pinsUsart[] = {PIN_USART1_TXD, PIN_USART1_RXD}; \
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_US1;\
+        AT91C_BASE_US1->US_IDR = 0xFFFFFFFF;\
+        PIO_Configure(pinsUsart, PIO_LISTSIZE(pinsUsart)); \
+        USART_Configure(AT91C_BASE_US1,USART_MODE_ASYNCHRONOUS, baudrate, mck); \
+        USART_SetTransmitterEnabled(AT91C_BASE_US1,1);\
+        USART_SetReceiverEnabled(AT91C_BASE_US1,1);\
+    }
+#elif defined(TRACE_USART_2)
+    #define TRACE_CONFIGURE(mode, baudrate, mck) { \
+        const Pin pinsUsart[] = {PIN_USART2_TXD, PIN_USART2_RXD}; \
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_US2;\
+        AT91C_BASE_US2->US_IDR = 0xFFFFFFFF;\
+        PIO_Configure(pinsUsart, PIO_LISTSIZE(pinsUsart)); \
+        USART_Configure(AT91C_BASE_US2,USART_MODE_ASYNCHRONOUS, baudrate, mck); \
+        USART_SetTransmitterEnabled(AT91C_BASE_US2,1);\
+        USART_SetReceiverEnabled(AT91C_BASE_US2,1);\
+    }
+#endif
+
+//------------------------------------------------------------------------------
+/// Initializes the trace for ISP project
+/// \param mode  DBGU mode.
+/// \param baudrate  DBGU baudrate.
+/// \param mck  Master clock frequency.
+//------------------------------------------------------------------------------
+#if (TRACE_LEVEL==0) && (DYN_TRACES==0)
+    #define TRACE_CONFIGURE_ISP(mode, baudrate, mck) {}
+#elif defined(TRACE_DBGU)
+    #define TRACE_CONFIGURE_ISP(mode, baudrate, mck) { \
+        const Pin pinsDbgu[] = {PINS_DBGU}; \
+        PIO_Configure(pinsDbgu, PIO_LISTSIZE(pinsDbgu)); \
+        DBGU_Configure(mode, baudrate, mck); \
+    }
+#elif defined(TRACE_USART_0)
+    #define TRACE_CONFIGURE_ISP(mode, baudrate, mck) { \
+        const Pin pinsUsart[] = {PIN_USART0_TXD, PIN_USART0_RXD}; \
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_US0;\
+        AT91C_BASE_US0->US_IDR = 0xFFFFFFFF;\
+        PIO_Configure(pinsUsart, PIO_LISTSIZE(pinsUsart)); \
+        USART_Configure(AT91C_BASE_US0,USART_MODE_ASYNCHRONOUS, baudrate, mck); \
+        USART_SetTransmitterEnabled(AT91C_BASE_US0,1);\
+        USART_SetReceiverEnabled(AT91C_BASE_US0,1);\
+    }
+#elif defined(TRACE_USART_1)
+    #define TRACE_CONFIGURE_ISP(mode, baudrate, mck) { \
+        const Pin pinsUsart[] = {PIN_USART1_TXD, PIN_USART1_RXD}; \
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_US1;\
+        AT91C_BASE_US1->US_IDR = 0xFFFFFFFF;\
+        PIO_Configure(pinsUsart, PIO_LISTSIZE(pinsUsart)); \
+        USART_Configure(AT91C_BASE_US1,USART_MODE_ASYNCHRONOUS, baudrate, mck); \
+        USART_SetTransmitterEnabled(AT91C_BASE_US1,1);\
+        USART_SetReceiverEnabled(AT91C_BASE_US1,1);\
+    }
+#elif defined(TRACE_USART_2)
+    #define TRACE_CONFIGURE_ISP(mode, baudrate, mck) { \
+        const Pin pinsUsart[] = {PIN_USART2_TXD, PIN_USART2_RXD}; \
+        AT91C_BASE_PMC->PMC_PCER = 1 << AT91C_ID_US2;\
+        AT91C_BASE_US2->US_IDR = 0xFFFFFFFF;\
+        PIO_Configure(pinsUsart, PIO_LISTSIZE(pinsUsart)); \
+        USART_Configure(AT91C_BASE_US2,USART_MODE_ASYNCHRONOUS, baudrate, mck); \
+        USART_SetTransmitterEnabled(AT91C_BASE_US2,1);\
+        USART_SetReceiverEnabled(AT91C_BASE_US2,1);\
+    }
+#endif
+
+//------------------------------------------------------------------------------
+/// Macros TRACE_PutChar & TRACE_GetChar & TRACE_IsRxReady
+//------------------------------------------------------------------------------
+#if defined(TRACE_DBGU)    
+    #define TRACE_PutChar(c)  DBGU_PutChar(c)
+    #define TRACE_GetChar()   DBGU_GetChar()
+    #define TRACE_IsRxReady() DBGU_IsRxReady()
+#elif defined(TRACE_USART_0)
+    #define TRACE_PutChar(c)  USART_PutChar(AT91C_BASE_US0, c)
+    #define TRACE_GetChar()   USART_GetChar(AT91C_BASE_US0)
+    #define TRACE_IsRxReady() USART_IsRxReady(AT91C_BASE_US0)
+#elif defined(TRACE_USART_1)
+    #define TRACE_PutChar(c)  USART_PutChar(AT91C_BASE_US1, c)
+    #define TRACE_GetChar()   USART_GetChar(AT91C_BASE_US1)
+    #define TRACE_IsRxReady() USART_IsRxReady(AT91C_BASE_US1)
+#elif defined(TRACE_USART_2)
+    #define TRACE_PutChar(c)  USART_PutChar(AT91C_BASE_US2, c)
+    #define TRACE_GetChar()   USART_GetChar(AT91C_BASE_US2)
+    #define TRACE_IsRxReady() USART_IsRxReady(AT91C_BASE_US2)
+#endif
+
+//------------------------------------------------------------------------------
+/// Outputs a formatted string using <printf> if the log level is high
+/// enough. Can be disabled by defining TRACE_LEVEL=0 during compilation.
+/// \param format  Formatted string to output.
+/// \param ...  Additional parameters depending on formatted string.
+//------------------------------------------------------------------------------
+#if defined(NOTRACE)
+
+// Empty macro
+#define TRACE_DEBUG(...)      { }
+#define TRACE_INFO(...)       { }
+#define TRACE_WARNING(...)    { }               
+#define TRACE_ERROR(...)      { }
+#define TRACE_FATAL(...)      { while(1); }
+
+#define TRACE_DEBUG_WP(...)   { }
+#define TRACE_INFO_WP(...)    { }
+#define TRACE_WARNING_WP(...) { }
+#define TRACE_ERROR_WP(...)   { }
+#define TRACE_FATAL_WP(...)   { while(1); }
+
+#elif (DYN_TRACES == 1)
+
+// Trace output depends on traceLevel value
+#define TRACE_DEBUG(...)      { if (traceLevel >= TRACE_LEVEL_DEBUG)   { printf("-D- " __VA_ARGS__); } }
+#define TRACE_INFO(...)       { if (traceLevel >= TRACE_LEVEL_INFO)    { printf("-I- " __VA_ARGS__); } }
+#define TRACE_WARNING(...)    { if (traceLevel >= TRACE_LEVEL_WARNING) { printf("-W- " __VA_ARGS__); } }
+#define TRACE_ERROR(...)      { if (traceLevel >= TRACE_LEVEL_ERROR)   { printf("-E- " __VA_ARGS__); } }
+#define TRACE_FATAL(...)      { if (traceLevel >= TRACE_LEVEL_FATAL)   { printf("-F- " __VA_ARGS__); while(1); } }
+
+#define TRACE_DEBUG_WP(...)   { if (traceLevel >= TRACE_LEVEL_DEBUG)   { printf(__VA_ARGS__); } }
+#define TRACE_INFO_WP(...)    { if (traceLevel >= TRACE_LEVEL_INFO)    { printf(__VA_ARGS__); } }
+#define TRACE_WARNING_WP(...) { if (traceLevel >= TRACE_LEVEL_WARNING) { printf(__VA_ARGS__); } }
+#define TRACE_ERROR_WP(...)   { if (traceLevel >= TRACE_LEVEL_ERROR)   { printf(__VA_ARGS__); } }
+#define TRACE_FATAL_WP(...)   { if (traceLevel >= TRACE_LEVEL_FATAL)   { printf(__VA_ARGS__); while(1); } }
+
+#else
+
+// Trace compilation depends on TRACE_LEVEL value
+#if (TRACE_LEVEL >= TRACE_LEVEL_DEBUG)
+#define TRACE_DEBUG(...)      { printf("-D- " __VA_ARGS__); }
+#define TRACE_DEBUG_WP(...)   { printf(__VA_ARGS__); }
+#else
+#define TRACE_DEBUG(...)      { }
+#define TRACE_DEBUG_WP(...)   { }
+#endif
+
+#if (TRACE_LEVEL >= TRACE_LEVEL_INFO)
+#define TRACE_INFO(...)       { printf("-I- " __VA_ARGS__); }
+#define TRACE_INFO_WP(...)    { printf(__VA_ARGS__); }
+#else
+#define TRACE_INFO(...)       { }
+#define TRACE_INFO_WP(...)    { }
+#endif
+
+#if (TRACE_LEVEL >= TRACE_LEVEL_WARNING)
+#define TRACE_WARNING(...)    { printf("-W- " __VA_ARGS__); }
+#define TRACE_WARNING_WP(...) { printf(__VA_ARGS__); }
+#else
+#define TRACE_WARNING(...)    { }
+#define TRACE_WARNING_WP(...) { }
+#endif
+
+#if (TRACE_LEVEL >= TRACE_LEVEL_ERROR)
+#define TRACE_ERROR(...)      { printf("-E- " __VA_ARGS__); }
+#define TRACE_ERROR_WP(...)   { printf(__VA_ARGS__); }
+#else
+#define TRACE_ERROR(...)      { }
+#define TRACE_ERROR_WP(...)   { }
+#endif
+
+#if (TRACE_LEVEL >= TRACE_LEVEL_FATAL)
+#define TRACE_FATAL(...)      { printf("-F- " __VA_ARGS__); while(1); }
+#define TRACE_FATAL_WP(...)   { printf(__VA_ARGS__); while(1); }
+#else
+#define TRACE_FATAL(...)      { while(1); }
+#define TRACE_FATAL_WP(...)   { while(1); }
+#endif
+
+#endif
+
+
+//------------------------------------------------------------------------------
+//         Exported variables
+//------------------------------------------------------------------------------
+// Depending on DYN_TRACES, traceLevel is a modifable runtime variable
+// or a define
+#if !defined(NOTRACE) && (DYN_TRACES == 1)
+    extern unsigned int traceLevel;
+#endif
+
+//------------------------------------------------------------------------------
+//         Global Functions
+//------------------------------------------------------------------------------
+
+extern void          TRACE_DumpFrame(unsigned char *pFrame, unsigned int size);
+
+extern void          TRACE_DumpMemory(unsigned char *pBuffer, unsigned int size, unsigned int address);
+
+extern unsigned char TRACE_GetInteger(unsigned int *pValue);
+
+extern unsigned char TRACE_GetIntegerMinMax(unsigned int *pValue, unsigned int min, unsigned int max);
+
+extern unsigned char TRACE_GetHexa32(unsigned int *pValue);
+
+#endif //#ifndef TRACE_H
+
diff --git a/usb-loader/samba_applets/at91lib/utility/utility.dir b/usb-loader/samba_applets/at91lib/utility/utility.dir
new file mode 100644
index 0000000000000000000000000000000000000000..b318e278da8e76cfd69b07a7308598a4f78ac3ac
--- /dev/null
+++ b/usb-loader/samba_applets/at91lib/utility/utility.dir
@@ -0,0 +1,50 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support 
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+/// \dir
+///
+/// !!!Purpose
+/// 
+/// The utility directory contains several very small APIs for performing
+/// specific tasks, such as LED configuration, BMP header decoding, etc.
+///
+/// !!!Contents
+///
+/// Most modules contained here are very small and do not fit in any of the
+/// other at91lib categories. They primarily provide helper functions
+/// (e.g. for handling BMP and WAV files) and re-implementation of libc code for
+/// reducing code size (math, stdio, string).
+///
+/// Two important files are assert.h and trace.h. The first one provides macros
+/// for run-time verifications of parameters & values. Trace.h enables the
+/// programmer to add debug traces to APIs that can be easily turned on or off
+/// depending on the debugging needs.
+//------------------------------------------------------------------------------
+
diff --git a/usb-loader/samba_applets/isp-project/common/applet.h b/usb-loader/samba_applets/isp-project/common/applet.h
new file mode 100644
index 0000000000000000000000000000000000000000..60ba37cc246a1c74a0047bc58416b6385ee41824
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/common/applet.h
@@ -0,0 +1,97 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+#ifndef APPLET_H
+#define APPLET_H
+
+//------------------------------------------------------------------------------
+//         Global definitions
+//------------------------------------------------------------------------------
+
+/// Refers to the Version of SAM-BA
+#define SAM_BA_APPLETS_VERSION  "2.9"
+
+/// Applet initialization command code.
+#define APPLET_CMD_INIT              0x00
+/// Applet full erase command code.
+#define APPLET_CMD_FULL_ERASE        0x01
+/// Applet write command code.
+#define APPLET_CMD_WRITE             0x02
+/// Applet read command code.
+#define APPLET_CMD_READ              0x03
+/// Applet read command code.
+#define APPLET_CMD_LOCK              0x04
+/// Applet read command code.
+#define APPLET_CMD_UNLOCK            0x05
+/// Applet set/clear GPNVM command code.
+#define APPLET_CMD_GPNVM             0x06
+/// Applet set security bit command code.
+#define APPLET_CMD_SECURITY          0x07
+/// Applet buffer erase command code.
+#define APPLET_CMD_BUFFER_ERASE      0x08
+/// Applet binary page command code for Dataflash.
+#define APPLET_CMD_BINARY_PAGE       0x09
+/// List Bad Blocks of a Nandflash
+#define APPLET_CMD_LIST_BAD_BLOCKS   0x10
+/// Tag a Nandflash Block
+#define APPLET_CMD_TAG_BLOCK         0x11
+/// Read the Unique ID bits (on SAM3)
+#define APPLET_CMD_READ_UNIQUE_ID    0x12
+
+/// Operation was successful.
+#define APPLET_SUCCESS          0x00
+/// Device unknown.
+#define APPLET_DEV_UNKNOWN      0x01
+/// Write operation failed.
+#define APPLET_WRITE_FAIL       0x02
+/// Read operation failed.
+#define APPLET_READ_FAIL        0x03
+/// Protect operation failed.
+#define APPLET_PROTECT_FAIL     0x04
+/// Unprotect operation failed.
+#define APPLET_UNPROTECT_FAIL   0x05
+/// Erase operation failed.
+#define APPLET_ERASE_FAIL       0x06
+/// No device defined in board.h
+#define APPLET_NO_DEV           0x07
+/// Read / write address is not aligned
+#define APPLET_ALIGN_ERROR      0x08
+/// Read / write found bad block
+#define APPLET_BAD_BLOCK        0x09
+/// Applet failure.
+#define APPLET_FAIL             0x0f
+
+
+/// Communication link identification
+#define USB_COM_TYPE            0x00
+#define DBGU_COM_TYPE           0x01
+#define JTAG_COM_TYPE           0x02
+
+#endif //#ifndef APPLET_H
+
diff --git a/usb-loader/samba_applets/isp-project/common/isp_cstartup.S b/usb-loader/samba_applets/isp-project/common/isp_cstartup.S
new file mode 100644
index 0000000000000000000000000000000000000000..420cfd460f06d49dcc7ece4f1670561fad37db7a
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/common/isp_cstartup.S
@@ -0,0 +1,110 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Startup routine
+//------------------------------------------------------------------------------
+
+        .align      4
+        .arm
+        
+/* Main Application entry
+ ************************/
+        .section    .text
+
+        .global     entry
+entry:
+        b       init             /* Branch to the init after the arguments */
+
+/* Mailbox area where PC application stores arguments
+ *****************************************************/
+mailbox:        
+        .space  4*32
+
+isInitialized:
+        .word  0x00
+        
+return_addr:
+		.word 0x00
+/* Store the return address to the current stack
+ ***********************************************/
+init: 
+/*  TO DO: we should not have to set sp to _ssstack. 
+ *         This is due to a bug in some ROM monitors
+ *         At the beginning of the go command, the monitor
+ *         does not return from main() thus the stack is 
+ *         not empty. In the same time after the go, the 
+ *         function returns at the begining of the main() */
+    ldr     sp, =_sstack
+/*    stmdb   sp!, {lr}
*/
+
+    stmdb   sp!, {r0-r12, lr}
+  
+/*	str lr,  [pc, #-(8+.-return_addr)]
*/
+
+/* Clear the zero segment only the first time the applet is loaded */  
+/* Check the is_initialized flag  */
+    ldr     r0, [pc, #-(8+.-isInitialized)]
+    mov     r1, #0
+    cmp     r0, r1
+    bne     2f
+    
+/* Clear the zero segment */
+    ldr     r0, =_szero
+    ldr     r1, =_ezero
+    mov     r2, #0
+1:
+    cmp     r0, r1
+    strcc   r2, [r0], #4
+    bcc     1b
+    
+/* Update the is_initialized flag */    
+    mov     r1, #1
+    str     r1, [pc, #-(8+.-isInitialized)]
+2:
+
+/* Branch to main()
+ ******************/
+    mov     r0, #1
+    add     r1, pc,#-(8+.-mailbox)
+    ldr     r3, =main
+    mov     lr, pc
+    bx      r3
+
+/* Jump back to SAM-BA Boot
+ **************************/
+
+	ldmia sp!, {r0-r12, lr}
+
+/*	ldr r0,  [pc, #-(8+.-return_addr)]
*/
+
+/*    ldmfd   sp!, {r0}
*/
+    bx      lr
+        
+
diff --git a/usb-loader/samba_applets/isp-project/common/isp_cstartup.c b/usb-loader/samba_applets/isp-project/common/isp_cstartup.c
new file mode 100644
index 0000000000000000000000000000000000000000..3cbd384b1cdadd4b7ccbf95d54444bd8f7c568ee
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/common/isp_cstartup.c
@@ -0,0 +1,133 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2009, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+#include "board.h"
+#include "board_lowlevel.h"
+#include "exceptions.h"
+
+//------------------------------------------------------------------------------
+//         Definitions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Prototypes
+//------------------------------------------------------------------------------
+
+// Stack top
+extern unsigned int _sstack;
+
+// Initialize segments
+extern unsigned int _sidata;
+extern unsigned int _sdata, _edata;
+extern unsigned int _szero, _ezero;
+
+// Default link entry
+extern int main(int argc, char **argv);
+
+// Reset entry
+void ResetException(void) __attribute__((__interrupt__));
+
+//------------------------------------------------------------------------------
+//         Exception Table
+//------------------------------------------------------------------------------
+__attribute__((section(".isr_vector")))
+IntFunc exception_table[] = {
+
+     /* Configure Initial Stack Pointer, using linker-generated symbols */
+    (IntFunc)&_sstack,
+    ResetException,         /* Initial PC, set to entry point  */
+    (unsigned int) 0 /*NMIException*/,
+    (unsigned int) 0 /*HardFaultException*/,
+    (unsigned int) 0 /*MemManageException*/,
+    (unsigned int) 0 /*BusFaultException*/,
+    (unsigned int) 0 /*UsageFaultException*/,
+    0, 0, 0, 0,             /* Reserved */
+    (unsigned int) 0 /*SVCHandler*/,
+    (unsigned int) 0 /*DebugMonitor*/,
+    0,                      /* Reserved */
+    (unsigned int) 0 /*PendSVC*/,
+    (unsigned int) 0 /*SysTickHandler*/,
+
+    /*
+    :
+    */
+};
+
+/// Applet Mailbox and initialization flag
+#define MAILBOX_SIZE 32
+__attribute__((section(".mailbox")))
+unsigned int mailbox[MAILBOX_SIZE];
+volatile unsigned int isInitialized = 0;
+
+//------------------------------------------------------------------------------
+//  Reset Handler
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// This is the code that gets called on processor reset. To initialize the
+/// device. And call the main() routine.
+//------------------------------------------------------------------------------
+void ResetException(void)
+{
+    unsigned int *pSrc, *pDest;
+
+    // Initialize data
+    // Zero fill bss
+    if (isInitialized == 0) {
+        pSrc = &_sidata;
+        for(pDest = &_sdata; pDest < &_edata;) {
+
+            *(pDest ++) = *(pSrc ++);
+        }
+
+        for (pDest = &_szero; pDest < &_ezero;) {
+
+            *(pDest ++) = 0;
+        }
+        isInitialized = 1;
+    }
+
+    LowLevelInit();
+
+    main(1, mailbox);
+}
+
+
+//------------------------------------------------------------------------------
+/// Returns the address of the exception table (in RAM)
+//------------------------------------------------------------------------------
+//IrqHandler * GetExceptionTable( void )
+//{
+//    return (IrqHandler *)0x20000000;
+//}
+
+
diff --git a/usb-loader/samba_applets/isp-project/dataflash/Makefile b/usb-loader/samba_applets/isp-project/dataflash/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..1d0d20e708e220bb17887677dcdd918ede4fc02c
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/dataflash/Makefile
@@ -0,0 +1,203 @@
+# ----------------------------------------------------------------------------
+#         ATMEL Microcontroller Software Support 
+# ----------------------------------------------------------------------------
+# Copyright (c) 2008, Atmel Corporation
+#
+# All rights reserved.
+#
+# Redistribution and use in source and binary forms, with or without
+# modification, are permitted provided that the following conditions are met:
+#
+# - Redistributions of source code must retain the above copyright notice,
+# this list of conditions and the disclaimer below.
+#
+# Atmel's name may not be used to endorse or promote products derived from
+# this software without specific prior written permission.
+#
+# DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+# MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+# DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+# LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+# OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+# LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+# NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+# EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+# ----------------------------------------------------------------------------
+
+# 	Makefile for compiling isp-project dataflash applet
+
+#-------------------------------------------------------------------------------
+#		User-modifiable options
+#-------------------------------------------------------------------------------
+
+# Chip & board used for compilation
+# (can be overriden by adding CHIP=chip and BOARD=board to the command-line)
+CHIP  = at91sam9260
+BOARD = at91sam9260-ek
+
+# Optimization level, put in comment for debugging
+OPTIMIZATION = -Os
+
+# install directory
+ifeq ($(CHIP),at91cap9)
+BOARD_DIR = $(BOARD)
+else
+BOARD_DIR = $(CHIP)-ek
+endif
+
+# define default install directory
+BOARD_DIR = $(CHIP)-ek
+ifeq ($(CHIP),at91cap9)
+BOARD_DIR = $(BOARD)
+endif
+
+INSTALLDIR = "../tcl_lib/$(BOARD_DIR)/"
+
+# AT91 library directory
+AT91LIB = ../../at91lib
+
+# Output file basename
+OUTPUT = isp-dataflash-$(CHIP)
+
+# Compile with chip specific features
+include $(AT91LIB)/boards/$(BOARD)/$(CHIP)/chip.mak
+
+# Compile for all memories available on the board (this sets $(MEMORIES))
+include $(AT91LIB)/boards/$(BOARD)/board.mak
+
+# Output directories
+BIN = bin
+OBJ = obj
+
+#-------------------------------------------------------------------------------
+#		Tools
+#-------------------------------------------------------------------------------
+
+# Tool suffix when cross-compiling
+CROSS_COMPILE = arm-none-eabi-
+
+# Compilation tools
+CC = $(CROSS_COMPILE)gcc
+SIZE = $(CROSS_COMPILE)size
+STRIP = $(CROSS_COMPILE)strip
+OBJCOPY = $(CROSS_COMPILE)objcopy
+
+# Flags
+INCLUDES += -I$(AT91LIB)/boards/$(BOARD)
+INCLUDES += -I$(AT91LIB)/peripherals
+INCLUDES += -I$(AT91LIB)/memories
+INCLUDES += -I$(AT91LIB)
+
+CFLAGS = -Wall -mlong-calls -ffunction-sections
+CFLAGS += -g $(OPTIMIZATION) $(INCLUDES) -D$(CHIP) -DDYN_TRACES
+ASFLAGS = -g $(OPTIMIZATION) $(INCLUDES) -D$(CHIP) -D__ASSEMBLY__
+LDFLAGS = -g $(OPTIMIZATION) -nostartfiles -Wl,-Map=$(OUTPUT).map,--gc-sections
+
+
+#-------------------------------------------------------------------------------
+# Trace level used for compilation
+#-------------------------------------------------------------------------------
+# (can be overriden by adding TRACE_LEVEL=#number to the command-line)
+# TRACE_LEVEL_DEBUG      5
+# TRACE_LEVEL_INFO       4
+# TRACE_LEVEL_WARNING    3
+# TRACE_LEVEL_ERROR      2
+# TRACE_LEVEL_FATAL      1
+# TRACE_LEVEL_NO_TRACE   0
+
+# Define if traces are allowed depending on the chip
+#-------------------------------------------------------------------------------
+# Info traces allowed by default
+TR_LEV = 4
+
+# Disable trace capability for devices with few memory
+ifeq ($(CHIP),at91sam7x128)
+CFLAGS += -UDYN_TRACES
+TR_LEV = 0
+endif
+
+CFLAGS += -DTRACE_LEVEL=$(TR_LEV)
+
+
+#-------------------------------------------------------------------------------
+#		Files
+#-------------------------------------------------------------------------------
+
+# Directories where source files can be found
+ISP = ..
+PERIPH = $(AT91LIB)/peripherals
+BOARDS = $(AT91LIB)/boards
+MEM = $(AT91LIB)/memories
+UTILITY = $(AT91LIB)/utility
+
+VPATH += $(ISP)/common
+VPATH += $(MEM)/spi-flash
+VPATH += $(UTILITY)
+VPATH += $(PERIPH)/dbgu
+VPATH += $(PERIPH)/pio
+VPATH += $(PERIPH)/irq
+VPATH += $(PERIPH)/cp15
+VPATH += $(BOARDS)/$(BOARD)
+VPATH += $(BOARDS)/$(BOARD)/$(CHIP)
+
+# Objects built from C source files
+C_OBJECTS += main.o
+C_OBJECTS += spid.o
+C_OBJECTS += at45.o
+C_OBJECTS += at45d.o
+C_OBJECTS += math.o
+C_OBJECTS += stdio.o
+C_OBJECTS += trace.o
+C_OBJECTS += dbgu.o
+C_OBJECTS += pio.o
+C_OBJECTS += aic.o
+C_OBJECTS += cp15.o
+C_OBJECTS += board_memories.o
+C_OBJECTS += board_lowlevel.o
+
+# Objects built from Assembly source files
+ASM_OBJECTS += isp_cstartup.o
+
+# Append OBJ and BIN directories to output filename
+OUTPUT := $(BIN)/$(OUTPUT)
+
+#-------------------------------------------------------------------------------
+#		Rules
+#-------------------------------------------------------------------------------
+all: $(BIN) $(OBJ) $(MEMORIES)
+
+$(BIN) $(OBJ):
+	mkdir $@
+
+define RULES
+C_OBJECTS_$(1) = $(addprefix $(OBJ)/$(1)_, $(C_OBJECTS))
+ASM_OBJECTS_$(1) = $(addprefix $(OBJ)/$(1)_, $(ASM_OBJECTS))
+
+$(1): $$(ASM_OBJECTS_$(1)) $$(C_OBJECTS_$(1)) 
+	$(CC) $(LDFLAGS) -T"$(AT91LIB)/boards/$(BOARD)/$(CHIP)/$$@_samba.lds" -o $(OUTPUT).elf $$^
+	$(OBJCOPY) -O binary $(OUTPUT).elf $(OUTPUT).bin
+	$(SIZE) $$^ $(OUTPUT).elf
+	@cp -f $(OUTPUT).bin $(INSTALLDIR)
+
+$$(C_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.c Makefile $(OBJ) $(BIN)
+	$(CC) $(CFLAGS) -D$(1) -c -o $$@ $$<
+
+$$(ASM_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.S Makefile $(OBJ) $(BIN)
+	$(CC) $(ASFLAGS) -D$(1) -c -o $$@ $$<
+
+debug:
+	perl ../../resources/gdb/debug.pl $(OUTPUT).elf
+
+endef
+
+$(foreach MEMORY, $(MEMORIES), $(eval $(call RULES,$(MEMORY))))
+
+clean:
+	-rm -f $(OBJ)/*.o $(BIN)/*.bin $(BIN)/*.elf $(BIN)/*.map
+
+install:
+	mkdir -p $(INSTALLDIR)
+	cp $(OUTPUT).bin $(INSTALLDIR)
+                                                          
diff --git a/usb-loader/samba_applets/isp-project/dataflash/build.sh b/usb-loader/samba_applets/isp-project/dataflash/build.sh
new file mode 100755
index 0000000000000000000000000000000000000000..bbe6aa461162d5ce20e78422b6e66cb355e4bd20
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/dataflash/build.sh
@@ -0,0 +1,3 @@
+#!/bin/sh
+
+make CROSS_COMPILE=/opt/gcc-codesourcery/bin/arm-none-eabi- CHIP=at91sam9g45 BOARD=at91sam9g45-ek MEMORIES=sram TRACE_LEVEL=5 DYN_TRACES=1 INSTALLDIR=../../ $1
\ No newline at end of file
diff --git a/usb-loader/samba_applets/isp-project/dataflash/main.c b/usb-loader/samba_applets/isp-project/dataflash/main.c
new file mode 100644
index 0000000000000000000000000000000000000000..ba134748202b292464b61efde2ee9c52c4761379
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/dataflash/main.c
@@ -0,0 +1,628 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "../common/applet.h"
+#include <board.h>
+#include <board_memories.h>
+#include <pio/pio.h>
+#include <utility/trace.h>
+#include <utility/math.h>
+#include <spi-flash/at45.h>
+#include <spi-flash/at45d.h>
+
+#include <string.h>
+
+//------------------------------------------------------------------------------
+//         Local definitions
+//------------------------------------------------------------------------------
+
+/// SPI clock frequency in Hz.
+#define SPCK    20000000
+
+#if defined (at91sam7s) || defined (at91sam7x) || defined (at91sam7l)|| defined (at91sam7se) || defined (at91sam7a3)
+/// Build a tiny applet for devices with small SRAM size
+#define TINY_APPPLET
+
+/// Stack size in SRAM
+#if defined (at91sam7se) 
+/// For at91sam7se, the applet run in sdram, stack also in sdram. 
+#define STACK_SIZE 0
+#else
+#define STACK_SIZE 0x100
+#endif
+
+#else
+/// Read write buffer size in DF page number 
+#define BUFFER_NB_PAGE 500
+#endif
+
+// Max size of data we can tranfsert in one shot
+#define PDC_MAX_COUNT 0xFFFF
+
+//------------------------------------------------------------------------------
+//         Local structures
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Structure for storing parameters for each command that can be performed by
+/// the applet.
+//------------------------------------------------------------------------------
+struct _Mailbox {
+
+    /// Command send to the monitor to be executed.
+    unsigned int command;
+    /// Returned status, updated at the end of the monitor execution.
+    unsigned int status;
+
+    /// Input Arguments in the argument area
+    union {
+
+        /// Input arguments for the Init command.
+        struct {
+
+            /// Communication link used.
+            unsigned int comType;
+            /// Trace level.
+            unsigned int traceLevel;
+            /// AT45 dataflash index.
+            unsigned int at45Idx;
+
+        } inputInit;
+
+        /// Output arguments for the Init command.
+        struct {
+
+            /// Memory size.
+            unsigned int memorySize;
+            /// Buffer address.
+            unsigned int bufferAddress;
+            /// Buffer size.
+            unsigned int bufferSize;
+
+        } outputInit;
+
+        /// Input arguments for the Write command.
+        struct {
+
+            /// Buffer address.
+            unsigned int bufferAddr;
+            /// Buffer size.
+            unsigned int bufferSize;
+            /// Memory offset.
+            unsigned int memoryOffset;
+
+        } inputWrite;
+
+        /// Output arguments for the Write command.
+        struct {
+
+            /// Bytes written.
+            unsigned int bytesWritten; 
+
+        } outputWrite;
+
+        /// Input arguments for the Read command.
+        struct {
+
+            /// Buffer address.
+            unsigned int bufferAddr;
+            /// Buffer size.
+            unsigned int bufferSize;
+            /// Memory offset.
+            unsigned int memoryOffset;
+
+        } inputRead;
+
+        /// Output arguments for the Read command.
+        struct {
+
+            /// Bytes read.
+            unsigned int bytesRead;
+
+        } outputRead;
+
+        /// Input arguments for the Full Erase command.
+        // NONE
+
+        /// Output arguments for the Full Erase command.
+        // NONE
+        
+        /// Input arguments for the Buffer Erase command.
+         struct {
+
+            /// Memory offset to be erase.
+            unsigned int memoryOffset;
+
+        } inputBufferErase;
+
+        /// Output arguments for the Buffer Erase command.
+        // NONE
+    } argument;    
+};
+
+//------------------------------------------------------------------------------
+/// Holds parameters to configure access to one AT45 dataflash.
+//------------------------------------------------------------------------------
+struct _At45Select {
+
+    /// Address of the SPI peripheral connected to the dataflash.
+    AT91PS_SPI pSpiHw;
+    /// SPI peripheral index (e.g. SPI0 -> 0, SPI1 -> 1).
+    unsigned char spiIndex;
+    /// SPI peripheral identifier.
+    unsigned char spiId;
+    /// List of pins used by the SPI (MISO, MOSI & SPCK, no NPCS).
+    const Pin *pPinsSpi;
+    /// Number of pins in list.
+    unsigned char numPinsSpi;
+    /// Chip select value.
+    unsigned char cs;
+    /// Chip select pin definition.
+    const Pin *pPinCs;
+};
+
+//------------------------------------------------------------------------------
+//         Global variables
+//------------------------------------------------------------------------------
+
+/// End of program space (code + data).
+extern unsigned int end;
+
+
+//------------------------------------------------------------------------------
+//         Local variables
+//------------------------------------------------------------------------------
+
+/// SPI driver instance.
+static Spid spid;
+
+/// AT45 driver instance.
+static At45 at45;
+
+/// Number of pages in dataflash.
+static unsigned int numPages;
+/// Size of one page in the dataflash, in bytes.
+static unsigned int pageSize;
+/// Size of the buffer used for read/write operations in bytes.
+static unsigned int bufferSize;
+
+#ifdef BOARD_AT45_A_SPI_BASE
+
+/// SPI pin list instance for dataflash A.
+static const Pin pinsSpiA[] = {BOARD_AT45_A_SPI_PINS};
+/// SPI chip select pin instance for dataflash A.
+static const Pin pinCsA[] = {BOARD_AT45_A_NPCS_PIN};
+
+#endif //#ifdef BOARD_AT45_A_SPI_BASE
+
+#ifdef BOARD_AT45_B_SPI_BASE
+
+/// SPI pin list instance for dataflash B.
+static const Pin pinsSpiB[] = {BOARD_AT45_B_SPI_PINS};
+/// SPI chip select pin instance for dataflash B.
+static const Pin pinCsB[] = {BOARD_AT45_B_NPCS_PIN};
+
+#endif //#ifdef BOARD_AT45_B_SPI_BASE
+
+/// List of dataflash that are defined in the current board.
+static const struct _At45Select at45Select[2] = {
+#ifdef BOARD_AT45_A_SPI_BASE
+    {
+        BOARD_AT45_A_SPI_BASE,
+        BOARD_AT45_A_SPI,
+        BOARD_AT45_A_SPI_ID,
+        pinsSpiA,
+        PIO_LISTSIZE(pinsSpiA),
+        BOARD_AT45_A_NPCS,
+        pinCsA
+    },
+#else
+    {0, 0, 0, 0, 0, 0, 0},
+#endif
+#ifdef BOARD_AT45_B_SPI_BASE
+    {
+        BOARD_AT45_B_SPI_BASE,
+        BOARD_AT45_B_SPI,
+        BOARD_AT45_B_SPI_ID,
+        pinsSpiB,
+        PIO_LISTSIZE(pinsSpiB),
+        BOARD_AT45_B_NPCS,
+        pinCsB
+    }
+#else
+    {0, 0, 0, 0, 0, 0, 0}
+#endif
+};
+
+/// Current Dataflash index 
+volatile unsigned char at45Index = 0;
+
+
+int checksum(unsigned char *buf, int size)
+{
+    int c = 0;
+    while(size--) c+=*buf++;
+    return c;
+}
+//------------------------------------------------------------------------------
+//         Global functions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Applet main entry. This function decodes received command and executes it.
+/// \param argc  always 1
+/// \param argv  Address of the argument area.
+//------------------------------------------------------------------------------
+int main(int argc, char **argv)
+{
+    struct _Mailbox *pMailbox = (struct _Mailbox *) argv;
+    const At45Desc *pDesc = 0;
+    unsigned int bytesToWrite, bytesToRead, bufferAddr, memoryOffset, packetSize;
+    // index on read/write buffer
+    unsigned char *pBuffer;
+    // Temporary buffer used for non page aligned read/write 
+    unsigned int tempBufferAddr;
+    // Offset in destination buffer during buffer copy
+    unsigned int bufferOffset;
+    unsigned char tmp[128];
+    
+    // Configure the DBGU
+//    TRACE_CONFIGURE_ISP(DBGU_STANDARD, 115200, BOARD_MCK);
+
+    // Configure pins (must be done each time because of some old ROM codes that reset PIO usage)
+    if (at45Select[at45Index].pSpiHw != 0) {
+        PIO_Configure(at45Select[at45Index].pPinsSpi, at45Select[at45Index].numPinsSpi);
+        PIO_Configure(at45Select[at45Index].pPinCs, 1);
+    }
+
+    // ----------------------------------------------------------
+    // INIT: 
+    // ----------------------------------------------------------
+    if (pMailbox->command == APPLET_CMD_INIT) {
+
+        at45Index = pMailbox->argument.inputInit.at45Idx;
+
+#if (DYN_TRACES == 1)
+//        traceLevel = pMailbox->argument.inputInit.traceLevel;
+#endif
+//        traceLevel = 4; //pMailbox->argument.inputInit.traceLevel;
+        
+        TRACE_INFO("-- DataFlash AT45 ISP Applet %s --\n\r", SAM_BA_APPLETS_VERSION);
+        TRACE_INFO("-- %s\n\r", BOARD_NAME);
+        TRACE_INFO("-- Compiled: %s %s --\n\r", __DATE__, __TIME__);
+
+        if (at45Select[at45Index].pSpiHw == 0) {
+
+            pMailbox->status = APPLET_NO_DEV;
+            pMailbox->argument.outputInit.bufferSize = 0;
+            pMailbox->argument.outputInit.memorySize = 0;
+            pMailbox->argument.outputInit.bufferAddress = (unsigned int) &end;
+
+            TRACE_INFO("INIT command: No Dataflash %d defined for this board\n\r", \
+                   pMailbox->argument.inputInit.at45Idx);
+          
+            pMailbox->status = APPLET_NO_DEV;
+            goto exit;
+        }
+
+        TRACE_INFO("INIT command: Dataflash %d : SPI 0x%x SPI_NPCS 0x%x (0x%x)\n\r", \
+               pMailbox->argument.inputInit.at45Idx,
+               at45Select[at45Index].spiIndex,
+               at45Select[at45Index].cs,
+               (unsigned int) &(pMailbox->argument.inputInit.at45Idx));
+
+        // Initialize the SPI and serial flash
+        SPID_Configure(&spid, at45Select[at45Index].pSpiHw, at45Select[at45Index].spiId);        
+        PIO_Configure(at45Select[at45Index].pPinsSpi, at45Select[at45Index].numPinsSpi);
+        PIO_Configure(at45Select[at45Index].pPinCs, 1);
+
+        TRACE_INFO("\tSPI NCSR 0x%x\n\r", AT45_CSR(BOARD_MCK, SPCK));
+        SPID_ConfigureCS(&spid, at45Select[at45Index].cs, AT45_CSR(BOARD_MCK, SPCK));
+        AT45_Configure(&at45, &spid, at45Select[at45Index].cs);
+        TRACE_INFO("\tSPI and AT45 drivers initialized\n\r");
+        
+#if defined (at91sam9m10) || defined (at91sam9g45)
+        pMailbox->argument.outputInit.bufferAddress = (unsigned int) AT91C_DDR2;
+#else
+        pMailbox->argument.outputInit.bufferAddress = (unsigned int) &end;
+#endif
+        // Read the JEDEC ID of the device to identify it
+        pDesc = AT45_FindDevice(&at45, AT45D_GetStatus(&at45));
+
+        if (!pDesc) {
+
+            pMailbox->status = APPLET_DEV_UNKNOWN;
+            pMailbox->argument.outputInit.bufferSize = 0;
+            pMailbox->argument.outputInit.memorySize = 0;
+            TRACE_INFO("\tDevice Unknown\n\r");
+            goto exit;
+        }
+
+        // Get device parameters
+        pMailbox->status = APPLET_SUCCESS;
+        numPages = AT45_PageNumber(&at45);
+        pageSize = AT45_PageSize(&at45);
+        
+#ifdef TINY_APPPLET        
+       bufferSize = AT91C_ISRAM_SIZE                 // sram size
+           - ( ((unsigned int) &end) - AT91C_ISRAM ) // program size (romcode, code+data)
+           - STACK_SIZE                                 // stack size (if same area of applet code)
+           - pageSize;                                 // tempbuffer size to to make not aligned write operations
+
+#else        
+        bufferSize = BUFFER_NB_PAGE * pageSize;
+#endif        
+        bufferSize -= bufferSize % pageSize;  // integer number of pages can be contained in each buffer
+        pMailbox->argument.outputInit.bufferSize = bufferSize;
+        pMailbox->argument.outputInit.memorySize = numPages * pageSize;
+        TRACE_INFO("\t%s numPages : %x pageSize : %x bufferAddr : 0x%x\n\r",
+               at45.pDesc->name, numPages, pageSize, pMailbox->argument.outputInit.bufferAddress);
+    }
+
+    // ----------------------------------------------------------
+    // WRITE: 
+    // ----------------------------------------------------------
+    else if (pMailbox->command == APPLET_CMD_WRITE) {
+
+//	  printf("Before-write: lr = %08x\n", *(unsigned int *)(0x22000000-4));
+
+        memoryOffset = pMailbox->argument.inputWrite.memoryOffset;
+        bufferAddr   = pMailbox->argument.inputWrite.bufferAddr;
+        bytesToWrite = pMailbox->argument.inputWrite.bufferSize;
+        TRACE_INFO("WRITE at offset: 0x%x buffer at : 0x%x of: 0x%x Bytes\n\r",
+               memoryOffset, bufferAddr, bytesToWrite);
+
+        pBuffer = (unsigned char *) bufferAddr;
+        tempBufferAddr = bufferAddr + bytesToWrite;
+	memcpy(bufferAddr + 0x10000+bytesToWrite, bufferAddr, bytesToWrite);
+        
+# if 1
+
+        if ((memoryOffset % pageSize) != 0) {
+            
+            // We are not page aligned, retrieve first page content to update it
+            // Flush temp buffer
+  //          DBGU_PutChar('a');
+
+            memset((unsigned int *)tempBufferAddr, 0xFF, pageSize);
+
+            bufferOffset = (memoryOffset % pageSize);
+            
+            if( (bytesToWrite + bufferOffset) < pageSize) {
+                packetSize = bytesToWrite;
+            }
+            else {
+                packetSize = pageSize - bufferOffset;
+            }
+            
+            memoryOffset -= bufferOffset;
+
+            // Read page to be updated
+            AT45D_Read(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
+
+            // Fill retrieved page with data to be programmed
+            memcpy((unsigned char *)(tempBufferAddr + bufferOffset), pBuffer, packetSize);
+
+            // Write the page contents
+            AT45D_Erase(&at45, memoryOffset);
+            AT45D_Write(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
+
+            bytesToWrite -= packetSize;
+            pBuffer += packetSize;
+            memoryOffset += pageSize;
+        }
+
+#endif
+
+
+        // If it remains more than one page to write
+        while (bytesToWrite >= pageSize) {
+            // Write the page contents 
+            DBGU_PutChar('.');
+//            TRACE_INFO("offset %x buffer %x\n", memoryOffset ,pBuffer);
+            AT45D_Erase(&at45, memoryOffset);
+            AT45D_Write(&at45, pBuffer, pageSize, memoryOffset);
+  //          DBGU_PutChar('d');
+
+            pBuffer += pageSize;
+            memoryOffset += pageSize;
+            bytesToWrite -= pageSize;
+        }
+
+
+
+#if 1
+        // Write remaining data
+        if (bytesToWrite > 0) {
+
+    //        DBGU_PutChar('c');
+            // Read previous content of page
+
+            AT45D_Read(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
+
+            // Fill retrieved block with data to be programmed
+            memcpy((unsigned char *)tempBufferAddr, pBuffer, bytesToWrite);
+
+            // Write the page contents
+            AT45D_Erase(&at45, memoryOffset);
+            AT45D_Write(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
+
+            // No more bytes to write
+            bytesToWrite = 0;
+        }
+
+#endif
+
+
+        TRACE_INFO("WRITE return byte written : 0x%x Bytes\n\r",
+               pMailbox->argument.inputWrite.bufferSize - bytesToWrite);
+
+
+        memoryOffset = pMailbox->argument.inputWrite.memoryOffset;
+        bufferAddr   = pMailbox->argument.inputWrite.bufferAddr;
+        bytesToWrite = pMailbox->argument.inputWrite.bufferSize;
+        
+	bufferAddr += 0x10000 + bytesToWrite;
+        TRACE_INFO("VERIFY at offset: 0x%x buffer at : 0x%x of: 0x%x Bytes\n\r",
+               memoryOffset, bufferAddr, bytesToWrite);
+
+	int fail = 0;
+	
+
+	while(bytesToWrite > 128)
+	{
+	    int n = (bytesToWrite > 128 ? 128 : bytesToWrite);
+	    int i;
+
+            AT45D_Read(&at45, tmp, n, memoryOffset);
+	    
+	    if(memcmp(tmp, bufferAddr, n))
+	    {
+//		TRACE_INFO("Buf at %x\n", bufferAddr);
+		for(i=0;i<n;i++)
+		{
+		    
+		    if(tmp[i]!=  *(unsigned char *)(bufferAddr + i))
+		      TRACE_INFO("%x: %x vs %x\n\r",memoryOffset + i, tmp[i], *(unsigned char *)(bufferAddr + i));
+		}
+		 fail = 1;
+	//	 break;
+	    }
+
+	    bufferAddr += n;
+	    bytesToWrite -= n;
+	    memoryOffset+=n;
+	}
+
+
+	if(fail)
+	    TRACE_INFO("Verification failure\n\r");
+
+        pMailbox->argument.outputWrite.bytesWritten = pMailbox->argument.inputWrite.bufferSize - bytesToWrite;
+        pMailbox->status = APPLET_SUCCESS;
+    }
+
+    // ----------------------------------------------------------
+    // READ: 
+    // ----------------------------------------------------------
+    else if (pMailbox->command == APPLET_CMD_READ) {
+
+        memoryOffset = pMailbox->argument.inputRead.memoryOffset;
+        bufferAddr   = pMailbox->argument.inputRead.bufferAddr;
+        bytesToRead  = pMailbox->argument.inputRead.bufferSize;
+
+        TRACE_INFO("READ at offset: 0x%x buffer at : 0x%x of: 0x%x Bytes\n\r",
+               memoryOffset, bufferAddr, bytesToRead);
+
+        pBuffer = (unsigned char *) bufferAddr;
+
+        // Read packet after packets
+        while (((unsigned int)pBuffer < (bufferAddr + bufferSize)) && (bytesToRead > 0)) {
+	    int i;
+	    
+            packetSize = min(PDC_MAX_COUNT, bytesToRead);
+            AT45D_Read(&at45, pBuffer, packetSize, memoryOffset);
+
+            pBuffer += packetSize;
+            bytesToRead -= packetSize;
+            memoryOffset += packetSize;
+        }
+        
+        TRACE_INFO("READ return byte read : 0x%x Bytes\n\r",
+               pMailbox->argument.inputRead.bufferSize - bytesToRead);
+
+        pMailbox->argument.outputRead.bytesRead = pMailbox->argument.inputRead.bufferSize - bytesToRead;
+        pMailbox->status = APPLET_SUCCESS;
+    }
+
+    // ----------------------------------------------------------
+    // FULL ERASE: 
+    // ----------------------------------------------------------
+    else if (pMailbox->command == APPLET_CMD_FULL_ERASE) {
+
+        TRACE_INFO("FULL ERASE command:\n\r");
+
+        memoryOffset = 0;
+        while (memoryOffset < (pageSize * numPages)) {
+			DBGU_PutChar('.');
+            // Erase the page
+            AT45D_Erase(&at45, memoryOffset);
+            memoryOffset += pageSize;
+        }
+        TRACE_INFO("Full Erase achieved\n\r");
+        pMailbox->status = APPLET_SUCCESS;
+    }
+    
+    // ----------------------------------------------------------
+    // BUFFER ERASE: 
+    // ----------------------------------------------------------
+    else if (pMailbox->command == APPLET_CMD_BUFFER_ERASE) {
+
+        TRACE_INFO("BUFFER ERASE command: \n\r");
+         
+        memoryOffset = pMailbox->argument.inputBufferErase.memoryOffset;
+        while (memoryOffset < (pMailbox->argument.inputBufferErase.memoryOffset + bufferSize)) {
+
+            // Erase the page
+            AT45D_Erase(&at45, memoryOffset);
+            memoryOffset += pageSize;
+        }
+        TRACE_INFO("Buffer Erase achieved\n\r");
+        pMailbox->status = APPLET_SUCCESS;
+    }
+    
+    // ----------------------------------------------------------
+    // CONFIGURE IN BINARY MODE (power of two page size): 
+    // ----------------------------------------------------------
+    else if (pMailbox->command == APPLET_CMD_BINARY_PAGE) {
+
+        TRACE_INFO("BINARY PAGE SET command\n\r");
+         // Configure power-of-2 binary page size.
+        AT45D_BinaryPage(&at45);
+        TRACE_INFO("Binary Page achieved\n\r");
+        pMailbox->status = APPLET_SUCCESS;
+    }
+
+exit :
+    // Acknowledge the end of command
+    TRACE_INFO("\tEnd of applet (command : %x --- status : %x)\n\r", pMailbox->command, pMailbox->status);
+
+    // Notify the host application of the end of the command processing
+    pMailbox->command = ~(pMailbox->command);
+
+
+//	  printf("After-write: lr = %08x\n", *(unsigned int *)(0x22000000-4));
+
+    return 0;
+}
+
diff --git a/usb-loader/samba_applets/isp-project/extram/Makefile b/usb-loader/samba_applets/isp-project/extram/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..ee3784624a51c4466d1c77a69472e5636e2fda20
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/extram/Makefile
@@ -0,0 +1,207 @@
+# ----------------------------------------------------------------------------
+#         ATMEL Microcontroller Software Support 
+# ----------------------------------------------------------------------------
+# Copyright (c) 2008, Atmel Corporation
+#
+# All rights reserved.
+#
+# Redistribution and use in source and binary forms, with or without
+# modification, are permitted provided that the following conditions are met:
+#
+# - Redistributions of source code must retain the above copyright notice,
+# this list of conditions and the disclaimer below.
+#
+# Atmel's name may not be used to endorse or promote products derived from
+# this software without specific prior written permission.
+#
+# DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+# MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+# DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+# LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+# OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+# LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+# NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+# EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+# ----------------------------------------------------------------------------
+
+# 	Makefile for compiling isp-project extram applet
+
+#-------------------------------------------------------------------------------
+#		User-modifiable options
+#-------------------------------------------------------------------------------
+
+# Chip & board used for compilation
+# (can be overriden by adding CHIP=chip and BOARD=board to the command-line)
+CHIP  = at91sam9260
+BOARD = at91sam9260-ek
+
+# Optimization level, put in comment for debugging
+OPTIMIZATION = -Os
+
+# define default install directory
+BOARD_DIR = $(CHIP)-ek
+ifeq ($(CHIP),at91cap9)
+BOARD_DIR = $(BOARD)
+endif
+
+INSTALLDIR = "../tcl_lib/$(BOARD_DIR)/"
+
+# AT91 library directory
+AT91LIB = ../../at91lib
+
+# Output file basename
+OUTPUT = isp-extram-$(CHIP)
+
+# Compile with chip specific features
+include $(AT91LIB)/boards/$(BOARD)/$(CHIP)/chip.mak
+
+# Compile for all memories available on the board (this sets $(MEMORIES))
+include $(AT91LIB)/boards/$(BOARD)/board.mak
+
+# Output directories
+BIN = bin
+OBJ = obj
+
+
+#-------------------------------------------------------------------------------
+#		Tools
+#-------------------------------------------------------------------------------
+
+# Tool suffix when cross-compiling
+CROSS_COMPILE = arm-none-eabi-
+
+# Compilation tools
+CC = $(CROSS_COMPILE)gcc
+SIZE = $(CROSS_COMPILE)size
+STRIP = $(CROSS_COMPILE)strip
+OBJCOPY = $(CROSS_COMPILE)objcopy
+
+# Flags
+INCLUDES += -I$(AT91LIB)/boards/$(BOARD)
+INCLUDES += -I$(AT91LIB)/peripherals
+INCLUDES += -I$(AT91LIB)/components
+INCLUDES += -I$(AT91LIB)
+
+ifeq (cortexm3,$(CHIP_CORE))
+    # For Cortex-M3: thumb code only mthumb32
+    TARGET_OPTS = -mcpu=cortex-m3 -mthumb 
+else
+    # ARM7 or 9
+    TARGET_OPTS =
+endif
+
+
+CFLAGS += $(TARGET_OPTS)
+CFLAGS += -Wall -mlong-calls -ffunction-sections
+CFLAGS += -g $(OPTIMIZATION) -mthumb $(INCLUDES) -D$(CHIP) -DDYN_TRACES -DTRACE_DBGU
+
+ASFLAGS = $(TARGET_OPTS) -Wall -g $(OPTIMIZATION) $(INCLUDES) -D$(CHIP) -D__ASSEMBLY__
+LDFLAGS = -g $(OPTIMIZATION) $(TARGET_OPTS) -Wl,-Map=$(OUTPUT).map,--gc-sections #-nostartfiles 
+
+#-------------------------------------------------------------------------------
+# Trace level used for compilation
+#-------------------------------------------------------------------------------
+# (can be overriden by adding TRACE_LEVEL=#number to the command-line)
+# TRACE_LEVEL_DEBUG      5
+# TRACE_LEVEL_INFO       4
+# TRACE_LEVEL_WARNING    3
+# TRACE_LEVEL_ERROR      2
+# TRACE_LEVEL_FATAL      1
+# TRACE_LEVEL_NO_TRACE   0
+
+# Define if traces are allowed depending on the chip
+#-------------------------------------------------------------------------------
+# Info traces allowed by default
+TR_LEV = 4
+
+# Disable trace capability for devices with few memory
+ifeq ($(CHIP),at91sam7se32)
+CFLAGS += -UDYN_TRACES
+TR_LEV = 0
+endif
+ifeq ($(CHIP),at91sam9260)
+CFLAGS += -UDYN_TRACES
+TR_LEV = 0
+endif
+
+CFLAGS += -DTRACE_LEVEL=$(TR_LEV)
+
+
+#-------------------------------------------------------------------------------
+#		Files
+#-------------------------------------------------------------------------------
+
+# Directories where source files can be found
+ISP = ..
+PERIPH = $(AT91LIB)/peripherals
+BOARDS = $(AT91LIB)/boards
+UTILITY = $(AT91LIB)/utility
+
+VPATH += $(ISP)/common
+VPATH += $(UTILITY)
+VPATH += $(PERIPH)/dbgu
+VPATH += $(PERIPH)/pio
+VPATH += $(PERIPH)/cp15
+VPATH += $(BOARDS)/$(BOARD)
+VPATH += $(BOARDS)/$(BOARD)/$(CHIP)
+
+# Objects built from C source files
+C_OBJECTS += main.o
+C_OBJECTS += board_memories.o
+C_OBJECTS += board_lowlevel.o
+C_OBJECTS += dbgu.o
+C_OBJECTS += pio.o
+C_OBJECTS += cp15.o
+C_OBJECTS += stdio.o
+C_OBJECTS += trace.o
+
+ifeq (cortexm3,$(CHIP_CORE))
+    # Cortex M3
+    C_OBJECTS += isp_cstartup.o
+    C_OBJECTS += exceptions.o
+else
+	# Objects built from Assembly source files
+	ASM_OBJECTS = isp_cstartup.o
+endif
+
+# Append OBJ and BIN directories to output filename
+OUTPUT := $(BIN)/$(OUTPUT)
+
+#-------------------------------------------------------------------------------
+#		Rules
+#-------------------------------------------------------------------------------
+
+all: $(BIN) $(OBJ) $(MEMORIES)
+
+$(BIN) $(OBJ):
+	mkdir $@
+
+define RULES
+C_OBJECTS_$(1) = $(addprefix $(OBJ)/$(1)_, $(C_OBJECTS))
+ASM_OBJECTS_$(1) = $(addprefix $(OBJ)/$(1)_, $(ASM_OBJECTS))
+
+$(1): $$(ASM_OBJECTS_$(1)) $$(C_OBJECTS_$(1)) 
+	$(CC) $(LDFLAGS) -T"$(AT91LIB)/boards/$(BOARD)/$(CHIP)/$$@_samba.lds" -o $(OUTPUT).elf $$^
+#bb/init.o bb/ddramc.o 
+	$(OBJCOPY) -O binary $(OUTPUT).elf $(OUTPUT).bin
+	$(SIZE) $$^ $(OUTPUT).elf
+	@cp -f $(OUTPUT).bin $(INSTALLDIR)
+
+$$(C_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.c Makefile $(OBJ) $(BIN)
+	$(CC) $(CFLAGS) -D$(1) -c -o $$@ $$<
+
+$$(ASM_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.S Makefile $(OBJ) $(BIN)
+	$(CC) $(ASFLAGS) -D$(1) -c -o $$@ $$<
+
+#debug:
+#	perl ../../resources/gdb/debug.pl $(OUTPUT).elf
+
+endef
+
+$(foreach MEMORY, $(MEMORIES), $(eval $(call RULES,$(MEMORY))))
+
+clean:
+	-rm -f $(OBJ)/*.o $(BIN)/*.bin $(BIN)/*.elf $(BIN)/*.map
+
diff --git a/usb-loader/samba_applets/isp-project/extram/build.sh b/usb-loader/samba_applets/isp-project/extram/build.sh
new file mode 100755
index 0000000000000000000000000000000000000000..bbe6aa461162d5ce20e78422b6e66cb355e4bd20
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/extram/build.sh
@@ -0,0 +1,3 @@
+#!/bin/sh
+
+make CROSS_COMPILE=/opt/gcc-codesourcery/bin/arm-none-eabi- CHIP=at91sam9g45 BOARD=at91sam9g45-ek MEMORIES=sram TRACE_LEVEL=5 DYN_TRACES=1 INSTALLDIR=../../ $1
\ No newline at end of file
diff --git a/usb-loader/samba_applets/isp-project/extram/ddramc.c b/usb-loader/samba_applets/isp-project/extram/ddramc.c
new file mode 100644
index 0000000000000000000000000000000000000000..480af5610834526783c78c8da8fc5fa0a7b869b6
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/extram/ddramc.c
@@ -0,0 +1,224 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support  -  ROUSSET  -
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2007, Stelian Pop <stelian.pop@leadtechdesign.com>
+ * Copyright (c) 2007 Lead Tech Design <www.leadtechdesign.com>
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaiimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ * File Name           : sdramc.c
+ * Object              :
+ * Creation            :
+ *-----------------------------------------------------------------------------
+ */
+#include "board.h"
+#include "ddramc.h"
+
+/* Write DDRC register */
+static void write_ddramc(unsigned int address, unsigned int offset, const unsigned int value)
+{
+	writel(value, (address + offset));
+}
+
+/* Read DDRC registers */
+static unsigned int read_ddramc(unsigned int address, unsigned int offset)
+{
+	return readl((address + offset));
+}
+
+//*----------------------------------------------------------------------------
+//* \fn    sdram_init
+//* \brief Initialize the SDDRC Controller
+//*----------------------------------------------------------------------------
+int ddram_init(unsigned int ddram_controller_address, unsigned int ddram_address, struct SDdramConfig *ddram_config)
+{
+	volatile unsigned int i;
+	unsigned int cr = 0;
+	
+	// Step 1: Program the memory device type
+	// Configure the DDR controller
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MDR, ddram_config->ddramc_mdr);
+
+	// Program the DDR Controller
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, ddram_config->ddramc_cr); 
+
+	// assume timings for 7.5ns min clock period
+	write_ddramc(ddram_controller_address, HDDRSDRC2_T0PR, ddram_config->ddramc_t0pr);
+
+	// pSDDRC->HDDRSDRC2_T1PR 
+	write_ddramc(ddram_controller_address, HDDRSDRC2_T1PR, ddram_config->ddramc_t1pr);
+
+	// pSDDRC->HDDRSDRC2_T2PR 
+	write_ddramc(ddram_controller_address, HDDRSDRC2_T2PR, ddram_config->ddramc_t2pr);
+
+	// Initialization Step 3: NOP command -> allow to enable clk
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+	*((unsigned volatile int*) ddram_address) = 0;
+ 
+	// Initialization Step 3 (must wait 200 us) (6 core cycles per iteration, core is at 396MHz: min 13200 loops)
+	for (i = 0; i < 13300; i++) {
+		asm("    nop");
+	}
+	
+	// Step 4:  An NOP command is issued to the DDR2-SDRAM 
+	// NOP command -> allow to enable cke
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NOP_CMD);
+	*((unsigned volatile int*) ddram_address) = 0;
+
+	// wait 400 ns min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 5: Set All Bank Precharge
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+	*((unsigned volatile int*) ddram_address) = 0;
+
+	// wait 400 ns min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+       // Initialization Step 6: Set EMR operation (EMRS2)
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*((unsigned int *)(ddram_address + 0x4000000)) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 7: Set EMR operation (EMRS3)
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*((unsigned int *)(ddram_address + 0x6000000)) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 8: Set EMR operation (EMRS1)
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*((unsigned int *)(ddram_address + 0x2000000)) = 0;
+
+	// wait 200 cycles min
+	for (i = 0; i < 10000; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 9: enable DLL reset
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr | AT91C_DDRC2_DLL_RESET_ENABLED);
+
+	// Initialization Step 10: reset DLL
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 11: Set All Bank Precharge
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_PRCGALL_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 400 ns min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 12: Two auto-refresh (CBR) cycles are provided. Program the auto refresh command (CBR) into the Mode Register.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 10 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Set 2nd CBR
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_RFSH_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// wait 10 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Initialization Step 13: Program DLL field into the Configuration Register to low(Disable DLL reset).
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_DLL_RESET_ENABLED));
+
+	// Initialization Step 14: A Mode Register set (MRS) cycle is issued to program the parameters of the DDR2-SDRAM devices.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_LMR_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// Step 15: Program OCD field into the Configuration Register to high (OCD calibration default).
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr | AT91C_DDRC2_OCD_DEFAULT);
+
+	// Step 16: An Extended Mode Register set (EMRS1) cycle is issued to OCD default value.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*(((unsigned int*) (ddram_address + 0x2000000))) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Step 17: Program OCD field into the Configuration Register to low (OCD calibration mode exit).
+	cr = read_ddramc(ddram_controller_address, HDDRSDRC2_CR);
+	write_ddramc(ddram_controller_address, HDDRSDRC2_CR, cr & (~AT91C_DDRC2_OCD_EXIT));
+
+	// Step 18: An Extended Mode Register set (EMRS1) cycle is issued to enable OCD exit.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_EXT_LMR_CMD);
+	*(((unsigned int*) (ddram_address + 0x6000000))) = 0;
+
+	// wait 2 cycles min
+	for (i = 0; i < 100; i++) {
+		asm("    nop");
+	}
+
+	// Step 19,20: A mode Normal command is provided. Program the Normal mode into Mode Register.
+	write_ddramc(ddram_controller_address, HDDRSDRC2_MR, AT91C_DDRC2_MODE_NORMAL_CMD);
+	*(((unsigned volatile int*) ddram_address)) = 0;
+
+	// Step 21: Write the refresh rate into the count field in the Refresh Timer register. The DDR2-SDRAM device requires a
+	// refresh every 15.625 ¦Is or 7.81 ¦Ìs. With a 100MHz frequency, the refresh timer count register must to be set with
+	// (15.625 /100 MHz) = 1562 i.e. 0x061A or (7.81 /100MHz) = 781 i.e. 0x030d.
+
+	// Set Refresh timer
+	write_ddramc(ddram_controller_address, HDDRSDRC2_RTR, ddram_config->ddramc_rtr);
+
+	// OK now we are ready to work on the DDRSDR
+
+	// wait for end of calibration
+	for (i = 0; i < 500; i++) {
+		asm("    nop");
+	}
+	
+	return 0;
+}
+
+#endif /* CFG_DDRAM */
diff --git a/usb-loader/samba_applets/isp-project/extram/ddramc.h b/usb-loader/samba_applets/isp-project/extram/ddramc.h
new file mode 100644
index 0000000000000000000000000000000000000000..f4c16f9524239944cf6b090be7a619160e94735a
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/extram/ddramc.h
@@ -0,0 +1,49 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support  -  ROUSSET  -
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2006, Atmel Corporation
+
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaiimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ * File Name           : sdramc.h
+ * Object              :
+ * Creation            : NLe Jul 11th 2006
+ *-----------------------------------------------------------------------------
+ */
+#ifndef DDRAMC_H_
+#define DDRAMC_H_
+
+typedef struct SDdramConfig
+{
+	unsigned int ddramc_mdr;
+	unsigned int ddramc_cr;
+	unsigned int ddramc_rtr;
+	unsigned int ddramc_t0pr;
+	unsigned int ddramc_t1pr;
+	unsigned int ddramc_t2pr;
+} SDdramConfig, *PSDdramConfig;
+
+extern int ddram_init(unsigned int ddram_controller_address, unsigned int ddram_address, struct SDdramConfig *ddram_config);
+extern void ddramc_hw_init(void);
+
+#endif /*SDRAMC_H_*/
diff --git a/usb-loader/samba_applets/isp-project/extram/main.c b/usb-loader/samba_applets/isp-project/extram/main.c
new file mode 100644
index 0000000000000000000000000000000000000000..c069bae285b3fc7f132751f68df4504455468b80
--- /dev/null
+++ b/usb-loader/samba_applets/isp-project/extram/main.c
@@ -0,0 +1,304 @@
+/* ----------------------------------------------------------------------------
+ *         ATMEL Microcontroller Software Support
+ * ----------------------------------------------------------------------------
+ * Copyright (c) 2008, Atmel Corporation
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * - Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the disclaimer below.
+ *
+ * Atmel's name may not be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
+ * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
+ * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
+ * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
+ * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * ----------------------------------------------------------------------------
+ */
+
+//------------------------------------------------------------------------------
+//         Headers
+//------------------------------------------------------------------------------
+
+#include "../common/applet.h"
+#include "ddramc.h"
+#include <board.h>
+#include <board_lowlevel.h>
+#include <board_memories.h>
+#include <pio/pio.h>
+#include <dbgu/dbgu.h>
+#include <utility/assert.h>
+#include <utility/trace.h>
+
+#include <string.h>
+
+//------------------------------------------------------------------------------
+//         External definitions
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+//         Local definitions
+//------------------------------------------------------------------------------
+
+#if defined(at91sam9g45) || defined(at91sam9m10)
+#define EXTRAM_ADDR AT91C_DDR2
+#define EXTRAM_SIZE BOARD_DDRAM_SIZE
+#elif at91sam3u4 
+#define EXTRAM_ADDR BOARD_EBI_PSRAM
+#define EXTRAM_SIZE BOARD_PSRAM_SIZE
+#else
+#define EXTRAM_ADDR AT91C_EBI_SDRAM
+#define EXTRAM_SIZE BOARD_SDRAM_SIZE
+#endif
+
+/// External RAM is SDRAM
+#define TYPE_SDRAM 0
+/// External RAM is DDRAM
+#define TYPE_DDRAM 1
+/// External RAM is PSRAM
+#define TYPE_PSRAM 2
+
+
+//------------------------------------------------------------------------------
+//         Local structure
+//------------------------------------------------------------------------------
+
+//------------------------------------------------------------------------------
+/// Structure for storing parameters for each command that can be performed by
+/// the applet.
+//------------------------------------------------------------------------------
+struct _Mailbox {
+
+    /// Command send to the monitor to be executed.
+    unsigned int command;
+    /// Returned status, updated at the end of the monitor execution.
+    unsigned int status;
+
+    /// Input Arguments in the argument area
+    union {
+
+        /// Input arguments for the Init command.
+        struct {
+
+            /// Communication link used.
+            unsigned int comType;
+            /// Trace level.
+            unsigned int traceLevel;
+            /// External memory voltage selection.
+            unsigned int VddMemSel;
+            /// External RAM type.
+            unsigned int ramType;
+            /// External RAM bus width.
+            unsigned int dataBusWidth;
+            /// External DDRAM Model.
+            unsigned int ddrModel;
+
+        } inputInit;
+
+        /// Output arguments for the Init command.
+        struct {
+
+            /// Memory size.
+            unsigned int memorySize;
+            /// Buffer address.
+            unsigned int bufferAddress;
+            /// Buffer size.
+            unsigned int bufferSize;
+        } outputInit;
+    } argument;
+};
+
+
+//------------------------------------------------------------------------------
+//         Global variables
+//------------------------------------------------------------------------------
+
+/// Marks the end of program space.
+extern unsigned int end;
+
+
+//------------------------------------------------------------------------------
+//         Local functions
+//------------------------------------------------------------------------------
+
+// ------------------------------------------------------------------------------
+/// Go/No-Go test of the first 10K-Bytes of external RAM access.
+/// \return 0 if test is failed else 1.
+//------------------------------------------------------------------------------
+
+int r_seed;
+
+void my_srand(int seed)
+{
+    r_seed = seed;
+}
+
+int my_rand()
+{
+    r_seed *= 101028131;
+    r_seed += 12345;
+    return r_seed;
+}
+static unsigned char ExtRAM_TestOk(void)
+{
+    unsigned int i;
+    unsigned int *ptr = (unsigned int *) EXTRAM_ADDR;
+
+/*    for(;;)
+    {
+	ptr[0] = 0xdeadbeef;
+	ptr[0x1000] = ~0xdeadbeef;
+    } */
+    
+    my_srand(0);
+    TRACE_INFO("testing External RAM");
+    for (i = 0; i < 512 * 1024; ++i) {
+        ptr[i] = my_rand();
+    }
+
+    my_srand(0);
+    for (i = 0; i < 512 * 1024; ++i) {
+        if (ptr[i] != my_rand()) {
+        	TRACE_INFO( "fail: %x %x\n\r", i, ptr[i]);
+                return 0;
+            }
+    }
+    return 1;
+}
+
+
+void delay(int x)
+{
+    while(x--) asm volatile("nop");
+}
+//------------------------------------------------------------------------------
+/// Applet code for initializing the external RAM.
+//------------------------------------------------------------------------------
+int main(int argc, char **argv)
+{
+    struct _Mailbox *pMailbox = (struct _Mailbox *) argv;
+    unsigned int ramType = 0;
+    unsigned int dataBusWidth = 0;
+    unsigned int ddrModel = 0;
+
+    LowLevelInit();
+
+    TRACE_CONFIGURE_ISP(DBGU_STANDARD, 115200, BOARD_MCK);
+    
+    
+
+/*    *AT91C_PMC_PCER = AT91C_ID_PIOA;
+    *AT91C_PIOA_PDR = (1<<31);
+    *AT91C_PIOA_OER = (1<<31);
+    *AT91C_PIOA_BSR = (1<<31);
+    *AT91C_PIOA_PER = (1<<0);
+    *AT91C_PIOA_OER = (1<<0);
+    
+    *AT91C_PMC_PCKR = (1<<8); // select master clock
+    *AT91C_PMC_SCER = (1<<8); // ENABLE PCK0*/
+    
+    TRACE_INFO("Statup: PMC_MCKR %x MCK = %d command = %d\n\r", *AT91C_PMC_MCKR, BOARD_MCK, pMailbox->command);
+    // ----------------------------------------------------------
+    // INIT:
+    // ----------------------------------------------------------
+    if (pMailbox->command == APPLET_CMD_INIT) {
+
+        // Initialize PMC
+//	BOARD_RemapRam();
+
+
+        // Enable User Reset
+        AT91C_BASE_RSTC->RSTC_RMR |= AT91C_RSTC_URSTEN | (0xA5<<24);
+        
+
+        ramType = pMailbox->argument.inputInit.ramType;
+        dataBusWidth = pMailbox->argument.inputInit.dataBusWidth;
+        ddrModel = pMailbox->argument.inputInit.ddrModel;
+
+//#if (DYN_TRACES == 1)
+//        traceLevel = pMailbox->argument.inputInit.traceLevel;
+//#endif
+
+        TRACE_INFO("-- EXTRAM ISP Applet %s --\n\r", SAM_BA_APPLETS_VERSION);
+        TRACE_INFO("-- %s\n\r", BOARD_NAME);
+        TRACE_INFO("-- Compiled: %s %s --\n\r", __DATE__, __TIME__);
+        TRACE_INFO("INIT command:\n\r");
+
+        TRACE_INFO("\tCommunication link type : %d\n\r", pMailbox->argument.inputInit.comType);
+        TRACE_INFO("\tData bus width : %d bits\n\r", dataBusWidth);
+        if (ramType == TYPE_SDRAM) {
+           TRACE_INFO("\tExternal RAM type : %s\n\r", "SDRAM");
+        }
+        else {
+            if (ramType == TYPE_DDRAM) {
+                TRACE_INFO("\tExternal RAM type : %s\n\r", "DDRAM");
+            }
+            else {
+                TRACE_INFO("\tExternal RAM type : %s\n\r", "PSRAM");
+            }
+        }
+
+#if defined(at91cap9) || defined(at91sam9m10) || defined(at91sam9g45)
+        TRACE_INFO("\tInit EBI Vdd : %s\n\r", (pMailbox->argument.inputInit.VddMemSel)?"3.3V":"1.8V");   
+        BOARD_ConfigureVddMemSel(pMailbox->argument.inputInit.VddMemSel);
+#endif //defined(at91cap9)
+
+        if (pMailbox->argument.inputInit.ramType == TYPE_SDRAM) {
+            // Configure SDRAM controller
+            TRACE_INFO("\tInit SDRAM...\n\r");
+#if defined(PINS_SDRAM)
+            BOARD_ConfigureSdram(dataBusWidth);
+#endif
+        }
+        else if (pMailbox->argument.inputInit.ramType == TYPE_PSRAM) {
+            TRACE_INFO("\tInit PSRAM...\n\r");   
+#if defined(at91sam3u4)            
+            BOARD_ConfigurePsram();
+#endif            
+        }
+        else { 
+            // Configure DDRAM controller
+#if defined(at91cap9dk) || defined(at91sam9m10) || defined(at91sam9g45)
+            TRACE_INFO("\tInit DDRAM ... (model : %d)\n\r", ddrModel);
+	    BOARD_ConfigureVddMemSel(VDDMEMSEL_1V8);
+            BOARD_ConfigureDdram(0, dataBusWidth);
+//	    ddramc_hw_init();
+#endif
+        }
+
+        // Test external RAM access
+        if (ExtRAM_TestOk()) {
+
+            pMailbox->status = APPLET_SUCCESS;
+        }
+        else {
+            pMailbox->status = APPLET_FAIL;
+        }
+
+        pMailbox->argument.outputInit.bufferAddress = ((unsigned int) &end);
+        pMailbox->argument.outputInit.bufferSize = 0;
+        pMailbox->argument.outputInit.memorySize = EXTRAM_SIZE;
+
+        TRACE_INFO("\tInit successful.\n\r");
+    }
+
+    // Acknowledge the end of command
+    TRACE_INFO("\tEnd of applet (command : %x --- status : %x)\n\r", pMailbox->command, pMailbox->status);
+
+    // Notify the host application of the end of the command processing
+    pMailbox->command = ~(pMailbox->command);
+
+    return 0;
+}
+
diff --git a/usb-loader/serial.h b/usb-loader/serial.h
new file mode 100644
index 0000000000000000000000000000000000000000..fe16f2804fb80b017d44ebefbfd550755d798c47
--- /dev/null
+++ b/usb-loader/serial.h
@@ -0,0 +1,27 @@
+/*      SAM7Sisp - alternatywny bootloader dla mikrokontrolerów AT91SAM7
+
+        (c) Tomasz Wlostowski 2006
+
+        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.
+*/
+
+
+#ifndef __SERIAL_H
+#define __SERIAL_H
+
+int serial_open(char *dev_name, int speed);
+void serial_close();
+void serial_set_dtr(int s);
+int serial_read(char *data, int len);
+int serial_write(char *data, int len);
+void serial_write_byte(unsigned char b);
+unsigned char serial_read_byte();
+int serial_data_avail();
+
+void sys_delay(int msecs);
+unsigned int sys_get_clock_usec();
+
+#endif
diff --git a/usb-loader/serial_linux.c b/usb-loader/serial_linux.c
new file mode 100644
index 0000000000000000000000000000000000000000..563394f8527cd829d08939ff67a52efcdff75e5f
--- /dev/null
+++ b/usb-loader/serial_linux.c
@@ -0,0 +1,140 @@
+/*      SAM7Sisp - alternatywny bootloader dla mikrokontrolerów AT91SAM7
+
+        (c) Tomasz Wlostowski 2006
+
+        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.
+*/
+
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <sys/time.h>
+#include <sys/types.h>
+#include <sys/ioctl.h>
+#include <asm/ioctls.h>
+#include <string.h>
+#include <termios.h>
+#include <fcntl.h>
+
+static int serial_fd;
+
+void serial_set_dtr(int s) // pin 4
+{
+    unsigned int v;
+    if (serial_fd<0) return;
+    ioctl(serial_fd,TIOCMGET,&v);
+    if (s) v|=TIOCM_DTR; else v&=~TIOCM_DTR;
+    ioctl(serial_fd,TIOCMSET,&v);
+}
+
+int serial_open(char *dev_name, int speed)
+{
+    struct termios t;
+    int fd;
+    int spd;
+
+    switch(speed)
+    {
+	case 115200: spd=B115200; break;
+	case 57600: spd=B57600; break;
+	case 38400: spd=B38400; break;
+	case 19200: spd=B19200; break;
+	case 9600: spd=B9600; break;
+	default: return -2;
+    }
+    
+    fd = open (dev_name, O_RDWR | O_NONBLOCK);
+
+    if(fd<0) return -1;
+
+
+    tcgetattr (fd, &t);
+    t.c_iflag = IGNBRK | IGNPAR;
+    t.c_oflag = t.c_lflag = t.c_line = 0;
+    t.c_cflag = CS8 | CREAD |  CLOCAL | HUPCL | spd;
+    tcsetattr (fd, TCSAFLUSH, &t);
+
+    serial_fd = fd;
+    return 0;
+}
+
+void serial_close()
+{
+    close(serial_fd);
+}
+
+int serial_write(char *data, int len)
+{
+//    printf("WS: '");
+    int i;
+//    for(i=0;i<len;i++) printf("%c", data[i]);
+//    printf("'\n");
+
+    return write(serial_fd, data, len);
+}
+
+
+int serial_read(char *data, int len)
+{
+    int nbytes=0;
+    while(len)
+    {
+	if(read(serial_fd, data, 1)==1) { len--;data++; nbytes++; }
+    }
+
+    return nbytes;
+};
+
+void serial_write_byte(unsigned char b)
+{
+//    printf("WB: '%c'\n", b);
+    write (serial_fd,&b,1);
+}
+
+unsigned char serial_read_byte()
+{
+    unsigned char b;
+    serial_read(&b,1);
+//    fprintf(stderr,"%02x ", b);
+    return b;
+
+}
+
+int serial_data_avail()
+{
+    fd_set set;
+    struct timeval tv;
+    
+    FD_ZERO(&set);
+    FD_SET(serial_fd,&set);
+    
+    tv.tv_sec = 0;
+    tv.tv_usec = 0;
+    
+    return select(serial_fd+1, &set, NULL, NULL, &tv)>0;
+}
+
+unsigned int sys_get_clock_usec()
+{
+    struct timezone tz={0,0};
+    struct timeval tv;
+
+    gettimeofday(&tv,&tz);
+    
+    return tv.tv_usec + tv.tv_sec * 1000000;    
+}
+
+void sys_delay(int msecs)
+{
+    usleep(msecs*1000);
+}
+
+void serial_purge()
+{
+  while(serial_data_avail()) serial_read_byte();
+}
\ No newline at end of file