board/bf537-stamp/bf537-stamp.c - github/trini/u-boot - Gitiles

 /*
  * U-boot - BF537.c
  *
  * Copyright (c) 2005-2007 Analog Devices Inc.
  *
  * (C) Copyright 2000-2004
  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  *
  * See file CREDITS for list of people who contributed to this
  * project.
  *
  * 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.
  *
  * This program is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  * GNU General Public License for more details.
  *
  * You should have received a copy of the GNU General Public License
  * along with this program; if not, write to the Free Software
  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
  * MA 02110-1301 USA
  */

 #include <common.h>
 #include <config.h>
 #include <command.h>
 #include <asm/blackfin.h>
 #include <asm/io.h>
 #include <net.h>
 #include "ether_bf537.h"

 /**
  * is_valid_ether_addr - Determine if the given Ethernet address is valid
  * @addr: Pointer to a six-byte array containing the Ethernet address
  *
  * Check that the Ethernet address (MAC) is not 00:00:00:00:00:00, is not
  * a multicast address, and is not FF:FF:FF:FF:FF:FF.
  *
  * Return true if the address is valid.
  */
 static inline int is_valid_ether_addr(const u8 * addr)
 {
 	/* FF:FF:FF:FF:FF:FF is a multicast address so we don't need to
 	 * explicitly check for it here. */
 	return !is_multicast_ether_addr(addr) && !is_zero_ether_addr(addr);
 }

 DECLARE_GLOBAL_DATA_PTR;

 #define POST_WORD_ADDR 0xFF903FFC

 /*
  * the bootldr command loads an address, checks to see if there
  *   is a Boot stream that the on-chip BOOTROM can understand,
  *   and loads it via the BOOTROM Callback. It is possible
  *   to also add booting from SPI, or TWI, but this function does
  *   not currently support that.
  */
 int do_bootldr(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
 {
 	ulong addr, entry;
 	ulong *data;

 	/* Get the address */
 	if (argc < 2) {
 		addr = load_addr;
 	} else {
 		addr = simple_strtoul(argv[1], NULL, 16);
 	}

 	/* Check if it is a LDR file */
 	data = (ulong *) addr;
 	if (*data == 0xFF800060 || *data == 0xFF800040 || *data == 0xFF800020) {
 		/* We want to boot from FLASH or SDRAM */
 		entry = _BOOTROM_BOOT_DXE_FLASH;
 		printf("## Booting ldr image at 0x%08lx ...\n", addr);
 		if (icache_status())
 			icache_disable();
 		if (dcache_status())
 			dcache_disable();

 	      __asm__("R7=%[a];\n" "P0=%[b];\n" "JUMP (P0);\n":
 	      :[a] "d"(addr),[b] "a"(entry)
 	      :"R7", "P0");

 	} else {
 		printf("## No ldr image at address 0x%08lx\n", addr);
 	}

 	return 0;
 }

 U_BOOT_CMD(bootldr, 2, 0, do_bootldr,
 	   "bootldr - boot ldr image from memory\n",
 	   "[addr]\n         - boot ldr image stored in memory\n");

 int checkboard(void)
 {
 #if (BFIN_CPU == ADSP_BF534)
 	printf("CPU:   ADSP BF534 Rev.: 0.%d\n", *pCHIPID >> 28);
 #elif (BFIN_CPU == ADSP_BF536)
 	printf("CPU:   ADSP BF536 Rev.: 0.%d\n", *pCHIPID >> 28);
 #else
 	printf("CPU:   ADSP BF537 Rev.: 0.%d\n", *pCHIPID >> 28);
 #endif
 	printf("Board: ADI BF537 stamp board\n");
 	printf("       Support: http://blackfin.uclinux.org/\n");
 	return 0;
 }

 #if defined(CONFIG_BFIN_IDE)

 void cf_outb(unsigned char val, volatile unsigned char *addr)
 {
 	*(addr) = val;
 	sync();
 }

 unsigned char cf_inb(volatile unsigned char *addr)
 {
 	volatile unsigned char c;

 	c = *(addr);
 	sync();

 	return c;
 }

 void cf_insw(unsigned short *sect_buf, unsigned short *addr, int words)
 {
 	int i;

 	for (i = 0; i < words; i++)
 		*(sect_buf + i) = *(addr);
 	sync();
 }

 void cf_outsw(unsigned short *addr, unsigned short *sect_buf, int words)
 {
 	int i;

 	for (i = 0; i < words; i++)
 		*(addr) = *(sect_buf + i);
 	sync();
 }
 #endif				/* CONFIG_BFIN_IDE */

 long int initdram(int board_type)
 {
 #ifdef DEBUG
 	int brate;
 	char *tmp = getenv("baudrate");
 	brate = simple_strtoul(tmp, NULL, 16);
 	printf("Serial Port initialized with Baud rate = %x\n", brate);
 	printf("SDRAM attributes:\n");
 	printf("tRCD %d SCLK Cycles,tRP %d SCLK Cycles,tRAS %d SCLK Cycles"
 	       "tWR %d SCLK Cycles,CAS Latency %d SCLK cycles \n",
 	       3, 3, 6, 2, 3);
 	printf("SDRAM Begin: 0x%x\n", CFG_SDRAM_BASE);
 	printf("Bank size = %d MB\n", CFG_MAX_RAM_SIZE >> 20);
 #endif
 	gd->bd->bi_memstart = CFG_SDRAM_BASE;
 	gd->bd->bi_memsize = CFG_MAX_RAM_SIZE;
 	return CFG_MAX_RAM_SIZE;
 }

 #if defined(CONFIG_MISC_INIT_R)
 /* miscellaneous platform dependent initialisations */
 int misc_init_r(void)
 {
 #if (BFIN_BOOT_MODE == BF537_BYPASS_BOOT)
 	char nid[32];
 	unsigned char *pMACaddr = (unsigned char *)0x203F0000;
 	u8 SrcAddr[6] = { 0x02, 0x80, 0xAD, 0x20, 0x31, 0xB8 };

 #if defined(CONFIG_CMD_NET)
 	/* The 0xFF check here is to make sure we don't use the address
 	 * in flash if it's simply been erased (aka all 0xFF values) */
 	if (getenv("ethaddr") == NULL && is_valid_ether_addr(pMACaddr)) {
 		sprintf(nid, "%02x:%02x:%02x:%02x:%02x:%02x",
 			pMACaddr[0], pMACaddr[1],
 			pMACaddr[2], pMACaddr[3], pMACaddr[4], pMACaddr[5]);
 		setenv("ethaddr", nid);
 	}
 	if (getenv("ethaddr")) {
 		SetupMacAddr(SrcAddr);
 	}
 #endif
 #endif				/* BFIN_BOOT_MODE == BF537_BYPASS_BOOT */

 #if defined(CONFIG_BFIN_IDE)
 #if defined(CONFIG_BFIN_TRUE_IDE)
 	/* Enable ATASEL when in True IDE mode */
 	printf("Using CF True IDE Mode\n");
 	cf_outb(0, (unsigned char *)CONFIG_CF_ATASEL_ENA);
 	udelay(1000);
 #elif defined(CONFIG_BFIN_CF_IDE)
 	/* Disable ATASEL when we're in Common Memory Mode */
 	printf("Using CF Common Memory Mode\n");
 	cf_outb(0, (unsigned char *)CONFIG_CF_ATASEL_DIS);
 	udelay(1000);
 #elif defined(CONFIG_BFIN_HDD_IDE)
 	printf("Using HDD IDE Mode\n");
 #endif
 	ide_init();
 #endif				/* CONFIG_BFIN_IDE */
 	return 0;
 }
 #endif				/* CONFIG_MISC_INIT_R */

 #ifdef CONFIG_POST
 #if (BFIN_BOOT_MODE != BF537_BYPASS_BOOT)
 /* Using sw10-PF5 as the hotkey */
 int post_hotkeys_pressed(void)
 {
 	return 0;
 }
 #else
 /* Using sw10-PF5 as the hotkey */
 int post_hotkeys_pressed(void)
 {
 	int delay = 3;
 	int i;
 	unsigned short value;

 	*pPORTF_FER &= ~PF5;
 	*pPORTFIO_DIR &= ~PF5;
 	*pPORTFIO_INEN |= PF5;

 	printf("########Press SW10 to enter Memory POST########: %2d ", delay);
 	while (delay--) {
 		for (i = 0; i < 100; i++) {
 			value = *pPORTFIO & PF5;
 			if (value != 0) {
 				break;
 			}
 			udelay(10000);
 		}
 		printf("\b\b\b%2d ", delay);
 	}
 	printf("\b\b\b 0");
 	printf("\n");
 	if (value == 0)
 		return 0;
 	else {
 		printf("Hotkey has been pressed, Enter POST . . . . . .\n");
 		return 1;
 	}
 }
 #endif
 #endif

 #if defined(CONFIG_POST) || defined(CONFIG_LOGBUFFER)
 void post_word_store(ulong a)
 {
 	volatile ulong *save_addr = (volatile ulong *)POST_WORD_ADDR;
 	*save_addr = a;
 }

 ulong post_word_load(void)
 {
 	volatile ulong *save_addr = (volatile ulong *)POST_WORD_ADDR;
 	return *save_addr;
 }
 #endif

 #ifdef CONFIG_POST
 int uart_post_test(int flags)
 {
 	return 0;
 }

 #define BLOCK_SIZE 0x10000
 #define VERIFY_ADDR 0x2000000
 extern int erase_block_flash(int);
 extern int write_data(long lStart, long lCount, uchar * pnData);
 int flash_post_test(int flags)
 {
 	unsigned short *pbuf, *temp;
 	int offset, n, i;
 	int value = 0;
 	int result = 0;
 	printf("\n");
 	pbuf = (unsigned short *)VERIFY_ADDR;
 	temp = pbuf;
 	for (n = FLASH_START_POST_BLOCK; n < FLASH_END_POST_BLOCK; n++) {
 		offset = (n - 7) * BLOCK_SIZE;
 		printf("--------Erase   block:%2d..", n);
 		erase_block_flash(n);
 		printf("OK\r");
 		printf("--------Program block:%2d...", n);
 		write_data(CFG_FLASH_BASE + offset, BLOCK_SIZE, pbuf);
 		printf("OK\r");
 		printf("--------Verify  block:%2d...", n);
 		for (i = 0; i < BLOCK_SIZE; i += 2) {
 			if (*(unsigned short *)(CFG_FLASH_BASE + offset + i) !=
 			    *temp++) {
 				value = 1;
 				result = 1;
 			}
 		}
 		if (value)
 			printf("failed\n");
 		else
 			printf("OK		%3d%%\r",
 			       (int)(
 				     (n + 1 -
 				      FLASH_START_POST_BLOCK) *
 				     100 / (FLASH_END_POST_BLOCK -
 					    FLASH_START_POST_BLOCK)));

 		temp = pbuf;
 		value = 0;
 	}
 	printf("\n");
 	if (result)
 		return -1;
 	else
 		return 0;
 }

 /****************************************************
  * LED1 ---- PF6	LED2 ---- PF7		    *
  * LED3 ---- PF8	LED4 ---- PF9		    *
  * LED5 ---- PF10	LED6 ---- PF11		    *
  ****************************************************/
 int led_post_test(int flags)
 {
 	*pPORTF_FER &= ~(PF6 | PF7 | PF8 | PF9 | PF10 | PF11);
 	*pPORTFIO_DIR |= PF6 | PF7 | PF8 | PF9 | PF10 | PF11;
 	*pPORTFIO_INEN &= ~(PF6 | PF7 | PF8 | PF9 | PF10 | PF11);
 	*pPORTFIO &= ~(PF6 | PF7 | PF8 | PF9 | PF10 | PF11);
 	udelay(1000000);
 	printf("LED1 on");
 	*pPORTFIO |= PF6;
 	udelay(1000000);
 	printf("\b\b\b\b\b\b\b");
 	printf("LED2 on");
 	*pPORTFIO |= PF7;
 	udelay(1000000);
 	printf("\b\b\b\b\b\b\b");
 	printf("LED3 on");
 	*pPORTFIO |= PF8;
 	udelay(1000000);
 	printf("\b\b\b\b\b\b\b");
 	printf("LED4 on");
 	*pPORTFIO |= PF9;
 	udelay(1000000);
 	printf("\b\b\b\b\b\b\b");
 	printf("LED5 on");
 	*pPORTFIO |= PF10;
 	udelay(1000000);
 	printf("\b\b\b\b\b\b\b");
 	printf("lED6 on");
 	*pPORTFIO |= PF11;
 	printf("\b\b\b\b\b\b\b ");
 	return 0;
 }

 /************************************************
  *  SW10 ---- PF5	SW11 ---- PF4		*
  *  SW12 ---- PF3	SW13 ---- PF2		*
  ************************************************/
 int button_post_test(int flags)
 {
 	int i, delay = 5;
 	unsigned short value = 0;
 	int result = 0;

 	*pPORTF_FER &= ~(PF5 | PF4 | PF3 | PF2);
 	*pPORTFIO_DIR &= ~(PF5 | PF4 | PF3 | PF2);
 	*pPORTFIO_INEN |= (PF5 | PF4 | PF3 | PF2);

 	printf("\n--------Press SW10: %2d ", delay);
 	while (delay--) {
 		for (i = 0; i < 100; i++) {
 			value = *pPORTFIO & PF5;
 			if (value != 0) {
 				break;
 			}
 			udelay(10000);
 		}
 		printf("\b\b\b%2d ", delay);
 	}
 	if (value != 0)
 		printf("\b\bOK");
 	else {
 		result = -1;
 		printf("\b\bfailed");
 	}

 	delay = 5;
 	printf("\n--------Press SW11: %2d ", delay);
 	while (delay--) {
 		for (i = 0; i < 100; i++) {
 			value = *pPORTFIO & PF4;
 			if (value != 0) {
 				break;
 			}
 			udelay(10000);
 		}
 		printf("\b\b\b%2d ", delay);
 	}
 	if (value != 0)
 		printf("\b\bOK");
 	else {
 		result = -1;
 		printf("\b\bfailed");
 	}

 	delay = 5;
 	printf("\n--------Press SW12: %2d ", delay);
 	while (delay--) {
 		for (i = 0; i < 100; i++) {
 			value = *pPORTFIO & PF3;
 			if (value != 0) {
 				break;
 			}
 			udelay(10000);
 		}
 		printf("\b\b\b%2d ", delay);
 	}
 	if (value != 0)
 		printf("\b\bOK");
 	else {
 		result = -1;
 		printf("\b\bfailed");
 	}

 	delay = 5;
 	printf("\n--------Press SW13: %2d ", delay);
 	while (delay--) {
 		for (i = 0; i < 100; i++) {
 			value = *pPORTFIO & PF2;
 			if (value != 0) {
 				break;
 			}
 			udelay(10000);
 		}
 		printf("\b\b\b%2d ", delay);
 	}
 	if (value != 0)
 		printf("\b\bOK");
 	else {
 		result = -1;
 		printf("\b\bfailed");
 	}
 	printf("\n");
 	return result;
 }
 #endif
	/*
	* U-boot - BF537.c
	*
	* Copyright (c) 2005-2007 Analog Devices Inc.
	*
	* (C) Copyright 2000-2004
	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	*
	* See file CREDITS for list of people who contributed to this
	* project.
	*
	* 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.
	*
	* This program is distributed in the hope that it will be useful,
	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	* GNU General Public License for more details.
	*
	* You should have received a copy of the GNU General Public License
	* along with this program; if not, write to the Free Software
	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
	* MA 02110-1301 USA
	*/

	#include <common.h>
	#include <config.h>
	#include <command.h>
	#include <asm/blackfin.h>
	#include <asm/io.h>
	#include <net.h>
	#include "ether_bf537.h"

	/**
	* is_valid_ether_addr - Determine if the given Ethernet address is valid
	* @addr: Pointer to a six-byte array containing the Ethernet address
	*
	* Check that the Ethernet address (MAC) is not 00:00:00:00:00:00, is not
	* a multicast address, and is not FF:FF:FF:FF:FF:FF.
	*
	* Return true if the address is valid.
	*/
	static inline int is_valid_ether_addr(const u8 * addr)
	{
	/* FF:FF:FF:FF:FF:FF is a multicast address so we don't need to
	* explicitly check for it here. */
	return !is_multicast_ether_addr(addr) && !is_zero_ether_addr(addr);
	}

	DECLARE_GLOBAL_DATA_PTR;

	#define POST_WORD_ADDR 0xFF903FFC

	/*
	* the bootldr command loads an address, checks to see if there
	* is a Boot stream that the on-chip BOOTROM can understand,
	* and loads it via the BOOTROM Callback. It is possible
	* to also add booting from SPI, or TWI, but this function does
	* not currently support that.
	*/
	int do_bootldr(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
	{
	ulong addr, entry;
	ulong *data;

	/* Get the address */
	if (argc < 2) {
	addr = load_addr;
	} else {
	addr = simple_strtoul(argv[1], NULL, 16);
	}

	/* Check if it is a LDR file */
	data = (ulong *) addr;
	if (data == 0xFF800060 \|\| data == 0xFF800040 \|\| *data == 0xFF800020) {
	/* We want to boot from FLASH or SDRAM */
	entry = _BOOTROM_BOOT_DXE_FLASH;
	printf("## Booting ldr image at 0x%08lx ...\n", addr);
	if (icache_status())
	icache_disable();
	if (dcache_status())
	dcache_disable();

	__asm__("R7=%[a];\n" "P0=%[b];\n" "JUMP (P0);\n":
	:[a] "d"(addr),[b] "a"(entry)
	:"R7", "P0");

	} else {
	printf("## No ldr image at address 0x%08lx\n", addr);
	}

	return 0;
	}

	U_BOOT_CMD(bootldr, 2, 0, do_bootldr,
	"bootldr - boot ldr image from memory\n",
	"[addr]\n - boot ldr image stored in memory\n");

	int checkboard(void)
	{
	#if (BFIN_CPU == ADSP_BF534)
	printf("CPU: ADSP BF534 Rev.: 0.%d\n", *pCHIPID >> 28);
	#elif (BFIN_CPU == ADSP_BF536)
	printf("CPU: ADSP BF536 Rev.: 0.%d\n", *pCHIPID >> 28);
	#else
	printf("CPU: ADSP BF537 Rev.: 0.%d\n", *pCHIPID >> 28);
	#endif
	printf("Board: ADI BF537 stamp board\n");
	printf(" Support: http://blackfin.uclinux.org/\n");
	return 0;
	}

	#if defined(CONFIG_BFIN_IDE)

	void cf_outb(unsigned char val, volatile unsigned char *addr)
	{
	*(addr) = val;
	sync();
	}

	unsigned char cf_inb(volatile unsigned char *addr)
	{
	volatile unsigned char c;

	c = *(addr);
	sync();

	return c;
	}

	void cf_insw(unsigned short sect_buf, unsigned short addr, int words)
	{
	int i;

	for (i = 0; i < words; i++)
	(sect_buf + i) = (addr);
	sync();
	}

	void cf_outsw(unsigned short addr, unsigned short sect_buf, int words)
	{
	int i;

	for (i = 0; i < words; i++)
	(addr) = (sect_buf + i);
	sync();
	}
	#endif /* CONFIG_BFIN_IDE */

	long int initdram(int board_type)
	{
	#ifdef DEBUG
	int brate;
	char *tmp = getenv("baudrate");
	brate = simple_strtoul(tmp, NULL, 16);
	printf("Serial Port initialized with Baud rate = %x\n", brate);
	printf("SDRAM attributes:\n");
	printf("tRCD %d SCLK Cycles,tRP %d SCLK Cycles,tRAS %d SCLK Cycles"
	"tWR %d SCLK Cycles,CAS Latency %d SCLK cycles \n",
	3, 3, 6, 2, 3);
	printf("SDRAM Begin: 0x%x\n", CFG_SDRAM_BASE);
	printf("Bank size = %d MB\n", CFG_MAX_RAM_SIZE >> 20);
	#endif
	gd->bd->bi_memstart = CFG_SDRAM_BASE;
	gd->bd->bi_memsize = CFG_MAX_RAM_SIZE;
	return CFG_MAX_RAM_SIZE;
	}

	#if defined(CONFIG_MISC_INIT_R)
	/* miscellaneous platform dependent initialisations */
	int misc_init_r(void)
	{
	#if (BFIN_BOOT_MODE == BF537_BYPASS_BOOT)
	char nid[32];
	unsigned char pMACaddr = (unsigned char )0x203F0000;
	u8 SrcAddr[6] = { 0x02, 0x80, 0xAD, 0x20, 0x31, 0xB8 };

	#if defined(CONFIG_CMD_NET)
	/* The 0xFF check here is to make sure we don't use the address
	* in flash if it's simply been erased (aka all 0xFF values) */
	if (getenv("ethaddr") == NULL && is_valid_ether_addr(pMACaddr)) {
	sprintf(nid, "%02x:%02x:%02x:%02x:%02x:%02x",
	pMACaddr[0], pMACaddr[1],
	pMACaddr[2], pMACaddr[3], pMACaddr[4], pMACaddr[5]);
	setenv("ethaddr", nid);
	}
	if (getenv("ethaddr")) {
	SetupMacAddr(SrcAddr);
	}
	#endif
	#endif /* BFIN_BOOT_MODE == BF537_BYPASS_BOOT */

	#if defined(CONFIG_BFIN_IDE)
	#if defined(CONFIG_BFIN_TRUE_IDE)
	/* Enable ATASEL when in True IDE mode */
	printf("Using CF True IDE Mode\n");
	cf_outb(0, (unsigned char *)CONFIG_CF_ATASEL_ENA);
	udelay(1000);
	#elif defined(CONFIG_BFIN_CF_IDE)
	/* Disable ATASEL when we're in Common Memory Mode */
	printf("Using CF Common Memory Mode\n");
	cf_outb(0, (unsigned char *)CONFIG_CF_ATASEL_DIS);
	udelay(1000);
	#elif defined(CONFIG_BFIN_HDD_IDE)
	printf("Using HDD IDE Mode\n");
	#endif
	ide_init();
	#endif /* CONFIG_BFIN_IDE */
	return 0;
	}
	#endif /* CONFIG_MISC_INIT_R */

	#ifdef CONFIG_POST
	#if (BFIN_BOOT_MODE != BF537_BYPASS_BOOT)
	/* Using sw10-PF5 as the hotkey */
	int post_hotkeys_pressed(void)
	{
	return 0;
	}
	#else
	/* Using sw10-PF5 as the hotkey */
	int post_hotkeys_pressed(void)
	{
	int delay = 3;
	int i;
	unsigned short value;

	*pPORTF_FER &= ~PF5;
	*pPORTFIO_DIR &= ~PF5;
	*pPORTFIO_INEN \|= PF5;

	printf("########Press SW10 to enter Memory POST########: %2d ", delay);
	while (delay--) {
	for (i = 0; i < 100; i++) {
	value = *pPORTFIO & PF5;
	if (value != 0) {
	break;
	}
	udelay(10000);
	}
	printf("\b\b\b%2d ", delay);
	}
	printf("\b\b\b 0");
	printf("\n");
	if (value == 0)
	return 0;
	else {
	printf("Hotkey has been pressed, Enter POST . . . . . .\n");
	return 1;
	}
	}
	#endif
	#endif

	#if defined(CONFIG_POST) \|\| defined(CONFIG_LOGBUFFER)
	void post_word_store(ulong a)
	{
	volatile ulong save_addr = (volatile ulong )POST_WORD_ADDR;
	*save_addr = a;
	}

	ulong post_word_load(void)
	{
	volatile ulong save_addr = (volatile ulong )POST_WORD_ADDR;
	return *save_addr;
	}
	#endif

	#ifdef CONFIG_POST
	int uart_post_test(int flags)
	{
	return 0;
	}

	#define BLOCK_SIZE 0x10000
	#define VERIFY_ADDR 0x2000000
	extern int erase_block_flash(int);
	extern int write_data(long lStart, long lCount, uchar * pnData);
	int flash_post_test(int flags)
	{
	unsigned short pbuf, temp;
	int offset, n, i;
	int value = 0;
	int result = 0;
	printf("\n");
	pbuf = (unsigned short *)VERIFY_ADDR;
	temp = pbuf;
	for (n = FLASH_START_POST_BLOCK; n < FLASH_END_POST_BLOCK; n++) {
	offset = (n - 7) * BLOCK_SIZE;
	printf("--------Erase block:%2d..", n);
	erase_block_flash(n);
	printf("OK\r");
	printf("--------Program block:%2d...", n);
	write_data(CFG_FLASH_BASE + offset, BLOCK_SIZE, pbuf);
	printf("OK\r");
	printf("--------Verify block:%2d...", n);
	for (i = 0; i < BLOCK_SIZE; i += 2) {
	if ((unsigned short )(CFG_FLASH_BASE + offset + i) !=
	*temp++) {
	value = 1;
	result = 1;
	}
	}
	if (value)
	printf("failed\n");
	else
	printf("OK %3d%%\r",
	(int)(
	(n + 1 -
	FLASH_START_POST_BLOCK) *
	100 / (FLASH_END_POST_BLOCK -
	FLASH_START_POST_BLOCK)));

	temp = pbuf;
	value = 0;
	}
	printf("\n");
	if (result)
	return -1;
	else
	return 0;
	}

	/****************************************************
	* LED1 ---- PF6 LED2 ---- PF7 *
	* LED3 ---- PF8 LED4 ---- PF9 *
	* LED5 ---- PF10 LED6 ---- PF11 *
	****************************************************/
	int led_post_test(int flags)
	{
	*pPORTF_FER &= ~(PF6 \| PF7 \| PF8 \| PF9 \| PF10 \| PF11);
	*pPORTFIO_DIR \|= PF6 \| PF7 \| PF8 \| PF9 \| PF10 \| PF11;
	*pPORTFIO_INEN &= ~(PF6 \| PF7 \| PF8 \| PF9 \| PF10 \| PF11);
	*pPORTFIO &= ~(PF6 \| PF7 \| PF8 \| PF9 \| PF10 \| PF11);
	udelay(1000000);
	printf("LED1 on");
	*pPORTFIO \|= PF6;
	udelay(1000000);
	printf("\b\b\b\b\b\b\b");
	printf("LED2 on");
	*pPORTFIO \|= PF7;
	udelay(1000000);
	printf("\b\b\b\b\b\b\b");
	printf("LED3 on");
	*pPORTFIO \|= PF8;
	udelay(1000000);
	printf("\b\b\b\b\b\b\b");
	printf("LED4 on");
	*pPORTFIO \|= PF9;
	udelay(1000000);
	printf("\b\b\b\b\b\b\b");
	printf("LED5 on");
	*pPORTFIO \|= PF10;
	udelay(1000000);
	printf("\b\b\b\b\b\b\b");
	printf("lED6 on");
	*pPORTFIO \|= PF11;
	printf("\b\b\b\b\b\b\b ");
	return 0;
	}

	/************************************************
	* SW10 ---- PF5 SW11 ---- PF4 *
	* SW12 ---- PF3 SW13 ---- PF2 *
	************************************************/
	int button_post_test(int flags)
	{
	int i, delay = 5;
	unsigned short value = 0;
	int result = 0;

	*pPORTF_FER &= ~(PF5 \| PF4 \| PF3 \| PF2);
	*pPORTFIO_DIR &= ~(PF5 \| PF4 \| PF3 \| PF2);
	*pPORTFIO_INEN \|= (PF5 \| PF4 \| PF3 \| PF2);

	printf("\n--------Press SW10: %2d ", delay);
	while (delay--) {
	for (i = 0; i < 100; i++) {
	value = *pPORTFIO & PF5;
	if (value != 0) {
	break;
	}
	udelay(10000);
	}
	printf("\b\b\b%2d ", delay);
	}
	if (value != 0)
	printf("\b\bOK");
	else {
	result = -1;
	printf("\b\bfailed");
	}

	delay = 5;
	printf("\n--------Press SW11: %2d ", delay);
	while (delay--) {
	for (i = 0; i < 100; i++) {
	value = *pPORTFIO & PF4;
	if (value != 0) {
	break;
	}
	udelay(10000);
	}
	printf("\b\b\b%2d ", delay);
	}
	if (value != 0)
	printf("\b\bOK");
	else {
	result = -1;
	printf("\b\bfailed");
	}

	delay = 5;
	printf("\n--------Press SW12: %2d ", delay);
	while (delay--) {
	for (i = 0; i < 100; i++) {
	value = *pPORTFIO & PF3;
	if (value != 0) {
	break;
	}
	udelay(10000);
	}
	printf("\b\b\b%2d ", delay);
	}
	if (value != 0)
	printf("\b\bOK");
	else {
	result = -1;
	printf("\b\bfailed");
	}

	delay = 5;
	printf("\n--------Press SW13: %2d ", delay);
	while (delay--) {
	for (i = 0; i < 100; i++) {
	value = *pPORTFIO & PF2;
	if (value != 0) {
	break;
	}
	udelay(10000);
	}
	printf("\b\b\b%2d ", delay);
	}
	if (value != 0)
	printf("\b\bOK");
	else {
	result = -1;
	printf("\b\bfailed");
	}
	printf("\n");
	return result;
	}
	#endif