return flash_write_cfiword(info, wp, cword);}/*----------------------------------------------------------------------- */int flash_real_protect(flash_info_t *info, long sector, int prot){	int retcode = 0;	flash_write_cmd(info, sector, 0, FLASH_CMD_CLEAR_STATUS);	flash_write_cmd(info, sector, 0, FLASH_CMD_PROTECT);	if(prot)		flash_write_cmd(info, sector, 0, FLASH_CMD_PROTECT_SET);	else		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;}/* * 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;	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 = 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_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);	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 */