flash_write_cmd (info, sector, 0, FLASH_CMD_PROTECT_CLEAR);	if ((retcode =	     flash_full_status_check (info, sector, info->erase_blk_tout,				      prot ? "protect" : "unprotect")) == 0) {		info->protect[sector] = prot;		/* Intel's unprotect unprotects all locking */		if (prot == 0) {			int i;			for (i = 0; i < info->sector_count; i++) {				if (info->protect[i])					flash_real_protect (info, i, 1);			}		}	}	return retcode;}/*----------------------------------------------------------------------- *  wait for XSR.7 to be set. Time out with an error if it does not. *  This routine does not set the flash to read-array mode. */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; */	if (info->portwidth == FLASH_CFI_8BIT	    && info->chipwidth == FLASH_CFI_16BIT) {		cp[0] = cmd;	} else if (info->portwidth == FLASH_CFI_16BIT		   && info->chipwidth == FLASH_CFI_16BIT) {		cp[0] = '\0';		cp[1] = 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){#if 0	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;		}	}#endif	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;	} else {		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;	uchar num_erase_regions;	int erase_region_size;	int erase_region_count;	info->start[0] = base;	if (flash_detect_cfi (info)) {#ifdef DEBUG_FLASH		printf ("portwidth=%d chipwidth=%d\n", info->portwidth, info->chipwidth);	/* test-only */#endif		size_ratio = 1;	/* info->portwidth / info->chipwidth; */		num_erase_regions =			flash_read_uchar (info,					  FLASH_OFFSET_NUM_ERASE_REGIONS);#ifdef DEBUG_FLASH		printf ("found %d erase regions\n", num_erase_regions);#endif		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_count = (tmp & 0xffff) + 1;			tmp >>= 16;			erase_region_size =				(tmp & 0xffff) ? ((tmp & 0xffff) * 256) : 128;			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);	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 */