mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-11-04 14:00:19 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			278 lines
		
	
	
		
			6.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			278 lines
		
	
	
		
			6.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * (C) Copyright 2000
 | 
						|
 * 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., 59 Temple Place, Suite 330, Boston,
 | 
						|
 * MA 02111-1307 USA
 | 
						|
 *
 | 
						|
 * Hacked for the Hymod board by Murray.Jensen@cmst.csiro.au, 20-Oct-00
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <mpc8xx.h>
 | 
						|
#include <galileo/gt64260R.h>
 | 
						|
#include <galileo/memory.h>
 | 
						|
#include "intel_flash.h"
 | 
						|
 | 
						|
 | 
						|
/*-----------------------------------------------------------------------
 | 
						|
 * Protection Flags:
 | 
						|
 */
 | 
						|
#define FLAG_PROTECT_SET	0x01
 | 
						|
#define FLAG_PROTECT_CLEAR	0x02
 | 
						|
 | 
						|
static void
 | 
						|
bank_reset(flash_info_t *info, int sect)
 | 
						|
{
 | 
						|
	bank_addr_t addrw, eaddrw;
 | 
						|
 | 
						|
	addrw = (bank_addr_t)info->start[sect];
 | 
						|
	eaddrw = BANK_ADDR_NEXT_WORD(addrw);
 | 
						|
 | 
						|
	while (addrw < eaddrw) {
 | 
						|
#ifdef FLASH_DEBUG
 | 
						|
		printf("  writing reset cmd to addr 0x%08lx\n",
 | 
						|
			(unsigned long)addrw);
 | 
						|
#endif
 | 
						|
		*addrw = BANK_CMD_RST;
 | 
						|
		addrw++;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void
 | 
						|
bank_erase_init(flash_info_t *info, int sect)
 | 
						|
{
 | 
						|
	bank_addr_t addrw, saddrw, eaddrw;
 | 
						|
	int flag;
 | 
						|
 | 
						|
#ifdef FLASH_DEBUG
 | 
						|
	printf("0x%08x BANK_CMD_PROG\n", BANK_CMD_PROG);
 | 
						|
	printf("0x%08x BANK_CMD_ERASE1\n", BANK_CMD_ERASE1);
 | 
						|
	printf("0x%08x BANK_CMD_ERASE2\n", BANK_CMD_ERASE2);
 | 
						|
	printf("0x%08x BANK_CMD_CLR_STAT\n", BANK_CMD_CLR_STAT);
 | 
						|
	printf("0x%08x BANK_CMD_RST\n", BANK_CMD_RST);
 | 
						|
	printf("0x%08x BANK_STAT_RDY\n", BANK_STAT_RDY);
 | 
						|
	printf("0x%08x BANK_STAT_ERR\n", BANK_STAT_ERR);
 | 
						|
#endif
 | 
						|
 | 
						|
	saddrw = (bank_addr_t)info->start[sect];
 | 
						|
	eaddrw = BANK_ADDR_NEXT_WORD(saddrw);
 | 
						|
 | 
						|
#ifdef FLASH_DEBUG
 | 
						|
	printf("erasing sector %d, start addr = 0x%08lx "
 | 
						|
		"(bank next word addr = 0x%08lx)\n", sect,
 | 
						|
		(unsigned long)saddrw, (unsigned long)eaddrw);
 | 
						|
#endif
 | 
						|
 | 
						|
	/* Disable intrs which might cause a timeout here */
 | 
						|
	flag = disable_interrupts();
 | 
						|
 | 
						|
	for (addrw = saddrw; addrw < eaddrw; addrw++) {
 | 
						|
#ifdef FLASH_DEBUG
 | 
						|
		printf("  writing erase cmd to addr 0x%08lx\n",
 | 
						|
			(unsigned long)addrw);
 | 
						|
#endif
 | 
						|
		*addrw = BANK_CMD_ERASE1;
 | 
						|
		*addrw = BANK_CMD_ERASE2;
 | 
						|
	}
 | 
						|
 | 
						|
	/* re-enable interrupts if necessary */
 | 
						|
	if (flag)
 | 
						|
		enable_interrupts();
 | 
						|
}
 | 
						|
 | 
						|
static int
 | 
						|
bank_erase_poll(flash_info_t *info, int sect)
 | 
						|
{
 | 
						|
	bank_addr_t addrw, saddrw, eaddrw;
 | 
						|
	int sectdone, haderr;
 | 
						|
 | 
						|
	saddrw = (bank_addr_t)info->start[sect];
 | 
						|
	eaddrw = BANK_ADDR_NEXT_WORD(saddrw);
 | 
						|
 | 
						|
	sectdone = 1;
 | 
						|
	haderr = 0;
 | 
						|
 | 
						|
	for (addrw = saddrw; addrw < eaddrw; addrw++) {
 | 
						|
		bank_word_t stat = *addrw;
 | 
						|
 | 
						|
#ifdef FLASH_DEBUG
 | 
						|
		printf("  checking status at addr "
 | 
						|
			"0x%08x [0x%08x]\n",
 | 
						|
			(unsigned long)addrw, stat);
 | 
						|
#endif
 | 
						|
		if ((stat & BANK_STAT_RDY) != BANK_STAT_RDY)
 | 
						|
			sectdone = 0;
 | 
						|
		else if ((stat & BANK_STAT_ERR) != 0) {
 | 
						|
			printf(" failed on sector %d "
 | 
						|
				"(stat = 0x%08x) at "
 | 
						|
				"address 0x%p\n",
 | 
						|
				sect, stat, addrw);
 | 
						|
			*addrw = BANK_CMD_CLR_STAT;
 | 
						|
			haderr = 1;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	if (haderr)
 | 
						|
		return (-1);
 | 
						|
	else
 | 
						|
		return (sectdone);
 | 
						|
}
 | 
						|
 | 
						|
int
 | 
						|
write_word_intel(bank_addr_t addr, bank_word_t value)
 | 
						|
{
 | 
						|
	bank_word_t stat;
 | 
						|
	ulong start;
 | 
						|
	int flag, retval;
 | 
						|
 | 
						|
	/* Disable interrupts which might cause a timeout here */
 | 
						|
	flag = disable_interrupts();
 | 
						|
 | 
						|
	*addr = BANK_CMD_PROG;
 | 
						|
 | 
						|
	*addr = value;
 | 
						|
 | 
						|
	/* re-enable interrupts if necessary */
 | 
						|
	if (flag)
 | 
						|
		enable_interrupts();
 | 
						|
 | 
						|
	retval = 0;
 | 
						|
 | 
						|
	/* data polling for D7 */
 | 
						|
	start = get_timer (0);
 | 
						|
	do {
 | 
						|
		if (get_timer(start) > CONFIG_SYS_FLASH_WRITE_TOUT) {
 | 
						|
			retval = 1;
 | 
						|
			goto done;
 | 
						|
		}
 | 
						|
		stat = *addr;
 | 
						|
	} while ((stat & BANK_STAT_RDY) != BANK_STAT_RDY);
 | 
						|
 | 
						|
	if ((stat & BANK_STAT_ERR) != 0) {
 | 
						|
		printf("flash program failed (stat = 0x%08lx) "
 | 
						|
			"at address 0x%08lx\n", (ulong)stat, (ulong)addr);
 | 
						|
		*addr = BANK_CMD_CLR_STAT;
 | 
						|
		retval = 3;
 | 
						|
	}
 | 
						|
 | 
						|
done:
 | 
						|
	/* reset to read mode */
 | 
						|
	*addr = BANK_CMD_RST;
 | 
						|
 | 
						|
	return (retval);
 | 
						|
}
 | 
						|
 | 
						|
/*-----------------------------------------------------------------------
 | 
						|
 */
 | 
						|
 | 
						|
int
 | 
						|
flash_erase_intel(flash_info_t *info, int s_first, int s_last)
 | 
						|
{
 | 
						|
	int prot, sect, haderr;
 | 
						|
	ulong start, now, last;
 | 
						|
 | 
						|
#ifdef FLASH_DEBUG
 | 
						|
	printf("\nflash_erase: erase %d sectors (%d to %d incl.) from\n"
 | 
						|
		"  Bank # %d: ", s_last - s_first + 1, s_first, s_last,
 | 
						|
		(info - flash_info) + 1);
 | 
						|
	flash_print_info(info);
 | 
						|
#endif
 | 
						|
 | 
						|
	if ((s_first < 0) || (s_first > s_last)) {
 | 
						|
		if (info->flash_id == FLASH_UNKNOWN) {
 | 
						|
			printf ("- missing\n");
 | 
						|
		} else {
 | 
						|
			printf ("- no sectors to erase\n");
 | 
						|
		}
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
 | 
						|
	prot = 0;
 | 
						|
	for (sect=s_first; sect<=s_last; ++sect) {
 | 
						|
		if (info->protect[sect]) {
 | 
						|
			prot++;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	if (prot) {
 | 
						|
		printf("- Warning: %d protected sector%s will not be erased!\n",
 | 
						|
			prot, (prot > 1 ? "s" : ""));
 | 
						|
	}
 | 
						|
 | 
						|
	start = get_timer (0);
 | 
						|
	last = 0;
 | 
						|
	haderr = 0;
 | 
						|
 | 
						|
	for (sect = s_first; sect <= s_last; sect++) {
 | 
						|
		if (info->protect[sect] == 0) {	/* not protected */
 | 
						|
			ulong estart;
 | 
						|
			int sectdone;
 | 
						|
 | 
						|
			bank_erase_init(info, sect);
 | 
						|
 | 
						|
			/* wait at least 80us - let's wait 1 ms */
 | 
						|
			udelay (1000);
 | 
						|
 | 
						|
			estart = get_timer(start);
 | 
						|
 | 
						|
			do {
 | 
						|
				now = get_timer(start);
 | 
						|
 | 
						|
				if (now - estart > CONFIG_SYS_FLASH_ERASE_TOUT) {
 | 
						|
					printf ("Timeout (sect %d)\n", sect);
 | 
						|
					haderr = 1;
 | 
						|
					break;
 | 
						|
				}
 | 
						|
 | 
						|
#ifndef FLASH_DEBUG
 | 
						|
				/* show that we're waiting */
 | 
						|
				if ((now - last) > 1000) { /* every second */
 | 
						|
					putc ('.');
 | 
						|
					last = now;
 | 
						|
				}
 | 
						|
#endif
 | 
						|
 | 
						|
				sectdone = bank_erase_poll(info, sect);
 | 
						|
 | 
						|
				if (sectdone < 0) {
 | 
						|
					haderr = 1;
 | 
						|
					break;
 | 
						|
				}
 | 
						|
 | 
						|
			} while (!sectdone);
 | 
						|
 | 
						|
			if (haderr)
 | 
						|
				break;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	if (haderr > 0)
 | 
						|
		printf (" failed\n");
 | 
						|
	else
 | 
						|
		printf (" done\n");
 | 
						|
 | 
						|
	/* reset to read mode */
 | 
						|
	for (sect = s_first; sect <= s_last; sect++) {
 | 
						|
		if (info->protect[sect] == 0) {	/* not protected */
 | 
						|
			bank_reset(info, sect);
 | 
						|
		}
 | 
						|
	}
 | 
						|
	return haderr;
 | 
						|
}
 |