*/static int flash_status_check(flash_info_t * info, ulong sector, ulong tout,			      char *prompt){	ulong start;	/* Wait for command completion */	start = get_timer(0);	while (!flash_isset(info, sector, 0, FLASH_STATUS_DONE)) {		if (get_timer(start) > info->erase_blk_tout) {			printf("Flash %s timeout at address %lx\n", prompt,			       info->start[sector]);			flash_write_cmd(info, sector, 0, FLASH_CMD_RESET);			return ERR_TIMOUT;		}	}	return ERR_OK;}/*----------------------------------------------------------------------- * Wait for XSR.7 to be set, if it times out print an error, otherwise do a full status check. * This routine sets the flash to read-array mode. */static int flash_full_status_check(flash_info_t * info, ulong sector,				   ulong tout, char *prompt){	int retcode;	retcode = flash_status_check(info, sector, tout, prompt);	if ((retcode == ERR_OK)	    && !flash_isequal(info, sector, 0, FLASH_STATUS_DONE)) {		retcode = ERR_INVAL;		printf("Flash %s error at address %lx\n", prompt,		       info->start[sector]);		if (flash_isset		    (info, sector, 0,		     FLASH_STATUS_ECLBS | FLASH_STATUS_PSLBS)) {			printf("Command Sequence Error.\n");		} else if (flash_isset(info, sector, 0, FLASH_STATUS_ECLBS)) {			printf("Block Erase Error.\n");			retcode = ERR_NOT_ERASED;		} else if (flash_isset(info, sector, 0, FLASH_STATUS_PSLBS)) {			printf("Locking Error\n");		}		if (flash_isset(info, sector, 0, FLASH_STATUS_DPS)) {			printf("Block locked.\n");			retcode = ERR_PROTECTED;		}		if (flash_isset(info, sector, 0, FLASH_STATUS_VPENS))			printf("Vpp Low Error.\n");	}	flash_write_cmd(info, sector, 0, FLASH_CMD_RESET);	return retcode;}/*----------------------------------------------------------------------- */static void flash_add_byte(flash_info_t * info, cfiword_t * cword, uchar c){	switch (info->portwidth) {	case FLASH_CFI_8BIT:		cword->c = c;		break;	case FLASH_CFI_16BIT:		cword->w = (cword->w << 8) | c;		break;	case FLASH_CFI_32BIT:		cword->l = (cword->l << 8) | c;	}}/*----------------------------------------------------------------------- * make a proper sized command based on the port and chip widths */static void flash_make_cmd(flash_info_t * info, uchar cmd, void *cmdbuf){	int i;	uchar *cp = (uchar *) cmdbuf;	for (i = 0; i < info->portwidth; i++)		*cp++ = ((i + 1) % info->chipwidth) ? '\0' : cmd;}/* * Write a proper sized command to the correct address */static void flash_write_cmd(flash_info_t * info, int sect, uchar offset,			    uchar cmd){	volatile cfiptr_t addr;	cfiword_t cword;	addr.cp = flash_make_addr(info, sect, offset);	flash_make_cmd(info, cmd, &cword);	switch (info->portwidth) {	case FLASH_CFI_8BIT:		*addr.cp = cword.c;		break;	case FLASH_CFI_16BIT:		*addr.wp = cword.w;		break;	case FLASH_CFI_32BIT:		*addr.lp = cword.l;		break;	}}/*----------------------------------------------------------------------- */static int flash_isequal(flash_info_t * info, int sect, uchar offset, uchar cmd){	cfiptr_t cptr;	cfiword_t cword;	int retval;	cptr.cp = flash_make_addr(info, sect, offset);	flash_make_cmd(info, cmd, &cword);	switch (info->portwidth) {	case FLASH_CFI_8BIT:		retval = (cptr.cp[0] == cword.c);		break;	case FLASH_CFI_16BIT:		retval = (cptr.wp[0] == cword.w);		break;	case FLASH_CFI_32BIT:		retval = (cptr.lp[0] == cword.l);		break;	default:		retval = 0;		break;	}	return retval;}/*----------------------------------------------------------------------- */static int flash_isset(flash_info_t * info, int sect, uchar offset, uchar cmd){	cfiptr_t cptr;	cfiword_t cword;	int retval;	cptr.cp = flash_make_addr(info, sect, offset);	flash_make_cmd(info, cmd, &cword);	switch (info->portwidth) {	case FLASH_CFI_8BIT:		retval = ((cptr.cp[0] & cword.c) == cword.c);		break;	case FLASH_CFI_16BIT:		retval = ((cptr.wp[0] & cword.w) == cword.w);		break;	case FLASH_CFI_32BIT:		retval = ((cptr.lp[0] & cword.l) == cword.l);		break;	default:		retval = 0;		break;	}	return retval;}/*----------------------------------------------------------------------- * detect if flash is compatible with the Common Flash Interface (CFI) * http://www.jedec.org/download/search/jesd68.pdf * */static int flash_detect_cfi(flash_info_t * info){	for (info->portwidth = FLASH_CFI_8BIT;	     info->portwidth <= FLASH_CFI_32BIT; info->portwidth <<= 1) {		for (info->chipwidth = FLASH_CFI_BY8;		     info->chipwidth <= info->portwidth;		     info->chipwidth <<= 1) {			flash_write_cmd(info, 0, 0, FLASH_CMD_RESET);			flash_write_cmd(info, 0, FLASH_OFFSET_CFI,					FLASH_CMD_CFI);			if (flash_isequal(info, 0, FLASH_OFFSET_CFI_RESP, 'Q')			    && flash_isequal(info, 0, FLASH_OFFSET_CFI_RESP + 1,					     'R')			    && flash_isequal(info, 0, FLASH_OFFSET_CFI_RESP + 2,					     'Y'))				return 1;		}	}	return 0;}/* * The following code cannot be run from FLASH! * */static ulong flash_get_size(ulong base, int banknum){	flash_info_t *info = &flash_info[banknum];	int i, j;	int sect_cnt;	unsigned long sector;	unsigned long tmp;	int size_ratio = 0;	uchar num_erase_regions;	int erase_region_size;	int erase_region_count;	info->start[0] = base;#if 0	invalidate_dcache_range(base, base + 0x400);#endif	if (flash_detect_cfi(info)) {		size_ratio = info->portwidth / info->chipwidth;		num_erase_regions =		    flash_read_uchar(info, FLASH_OFFSET_NUM_ERASE_REGIONS);		sect_cnt = 0;		sector = base;		for (i = 0; i < num_erase_regions; i++) {			if (i > NUM_ERASE_REGIONS) {				printf("%d erase regions found, only %d used\n",				       num_erase_regions, NUM_ERASE_REGIONS);				break;			}			tmp =			    flash_read_long(info, 0,					    FLASH_OFFSET_ERASE_REGIONS);			erase_region_size =			    (tmp & 0xffff) ? ((tmp & 0xffff) * 256) : 128;			tmp >>= 16;			erase_region_count = (tmp & 0xffff) + 1;			for (j = 0; j < erase_region_count; j++) {				info->start[sect_cnt] = sector;				sector += (erase_region_size * size_ratio);				info->protect[sect_cnt] =				    flash_isset(info, sect_cnt,						FLASH_OFFSET_PROTECT,						FLASH_STATUS_PROTECT);				sect_cnt++;			}		}		info->sector_count = sect_cnt;		/* multiply the size by the number of chips */		info->size =		    (1 << flash_read_uchar(info, FLASH_OFFSET_SIZE)) *		    size_ratio;		info->buffer_size =		    (1 << flash_read_ushort(info, 0, FLASH_OFFSET_BUFFER_SIZE));		tmp = 1 << flash_read_uchar(info, FLASH_OFFSET_ETOUT);		info->erase_blk_tout =		    (tmp *		     (1 << flash_read_uchar(info, FLASH_OFFSET_EMAX_TOUT)));		tmp = 1 << flash_read_uchar(info, FLASH_OFFSET_WBTOUT);		info->buffer_write_tout =		    (tmp *		     (1 << flash_read_uchar(info, FLASH_OFFSET_WBMAX_TOUT)));		tmp = 1 << flash_read_uchar(info, FLASH_OFFSET_WTOUT);		info->write_tout =		    (tmp *		     (1 << flash_read_uchar(info, FLASH_OFFSET_WMAX_TOUT))) /		    1000;		info->flash_id = FLASH_MAN_CFI;	}	flash_write_cmd(info, 0, 0, FLASH_CMD_RESET);#ifdef DEBUG_FLASH	printf("portwidth=%d chipwidth=%d\n", info->portwidth, info->chipwidth);	/* test-only */#endif#ifdef DEBUG_FLASH	printf("found %d erase regions\n", num_erase_regions);#endif#ifdef DEBUG_FLASH	printf("size=%08x sectors=%08x \n", info->size, info->sector_count);#endif	return (info->size);}/*----------------------------------------------------------------------- */static int flash_write_cfiword(flash_info_t * info, ulong dest, cfiword_t cword){	cfiptr_t ctladdr;	cfiptr_t cptr;	int flag;	ctladdr.cp = flash_make_addr(info, 0, 0);	cptr.cp = (uchar *) dest;	/* Check if Flash is (sufficiently) erased */	switch (info->portwidth) {	case FLASH_CFI_8BIT:		flag = ((cptr.cp[0] & cword.c) == cword.c);		break;	case FLASH_CFI_16BIT:		flag = ((cptr.wp[0] & cword.w) == cword.w);		break;	case FLASH_CFI_32BIT:		flag = ((cptr.lp[0] & cword.l) == cword.l);		break;	default:		return 2;	}	if (!flag)		return 2;	/* Disable interrupts which might cause a timeout here */	flag = disable_interrupts();	flash_write_cmd(info, 0, 0, FLASH_CMD_CLEAR_STATUS);	flash_write_cmd(info, 0, 0, FLASH_CMD_WRITE);	switch (info->portwidth) {	case FLASH_CFI_8BIT:		cptr.cp[0] = cword.c;		break;	case FLASH_CFI_16BIT:		cptr.wp[0] = cword.w;		break;	case FLASH_CFI_32BIT:		cptr.lp[0] = cword.l;		break;	}	/* re-enable interrupts if necessary */	if (flag)		enable_interrupts();	return flash_full_status_check(info, 0, info->write_tout, "write");}#ifdef CFG_FLASH_USE_BUFFER_WRITE/* loop through the sectors from the highest address * when the passed address is greater or equal to the sector address * we have a match */static int find_sector(flash_info_t * info, ulong addr){	int sector;	for (sector = info->sector_count - 1; sector >= 0; sector--) {		if (addr >= info->start[sector])			break;	}	return sector;}static int flash_write_cfibuffer(flash_info_t * info, ulong dest, uchar * cp,				 int len){	int sector;	int cnt;	int retcode;	volatile cfiptr_t src;	volatile cfiptr_t dst;	src.cp = cp;	dst.cp = (uchar *) dest;	sector = find_sector(info, dest);	flash_write_cmd(info, sector, 0, FLASH_CMD_CLEAR_STATUS);	flash_write_cmd(info, sector, 0, FLASH_CMD_WRITE_TO_BUFFER);	if ((retcode = flash_status_check(info, sector, info->buffer_write_tout,					  "write to buffer")) == ERR_OK) {		switch (info->portwidth) {		case FLASH_CFI_8BIT:			cnt = len;			break;		case FLASH_CFI_16BIT:			cnt = len >> 1;			break;		case FLASH_CFI_32BIT:			cnt = len >> 2;			break;		default:			return ERR_INVAL;			break;		}		flash_write_cmd(info, sector, 0, (uchar) cnt - 1);		while (cnt-- > 0) {			switch (info->portwidth) {			case FLASH_CFI_8BIT:				*dst.cp++ = *src.cp++;				break;			case FLASH_CFI_16BIT:				*dst.wp++ = *src.wp++;				break;			case FLASH_CFI_32BIT:				*dst.lp++ = *src.lp++;				break;			default:				return ERR_INVAL;				break;			}		}		flash_write_cmd(info, sector, 0,				FLASH_CMD_WRITE_BUFFER_CONFIRM);		retcode =		    flash_full_status_check(info, sector,					    info->buffer_write_tout,					    "buffer write");	}	flash_write_cmd(info, sector, 0, FLASH_CMD_CLEAR_STATUS);	return retcode;}#endif				/* CFG_USE_FLASH_BUFFER_WRITE */