board/mpl/common/common_util.c - platform/external/u-boot - Gitiles

 /*
  * (C) Copyright 2001
  * Denis Peter, MPL AG Switzerland, d.peter@mpl.ch
  *
  * 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
  *
  */

 #include <common.h>
 #include <command.h>
 #include <video_fb.h>
 #include "common_util.h"
 #include <asm/processor.h>
 #include <asm/byteorder.h>
 #include <i2c.h>
 #include <devices.h>
 #include <pci.h>
 #include <malloc.h>
 #include <bzlib.h>

 #ifdef CONFIG_PIP405
 #include "../pip405/pip405.h"
 #include <asm/4xx_pci.h>
 #endif
 #ifdef CONFIG_MIP405
 #include "../mip405/mip405.h"
 #include <asm/4xx_pci.h>
 #endif

 DECLARE_GLOBAL_DATA_PTR;

 #if defined(CONFIG_PATI)
 #define FIRM_START 0xFFF00000
 #endif

 extern int gunzip(void *, int, uchar *, unsigned long *);
 extern int mem_test(ulong start, ulong ramsize, int quiet);

 #define I2C_BACKUP_ADDR 0x7C00		/* 0x200 bytes for backup */
 #define IMAGE_SIZE CFG_MONITOR_LEN	/* ugly, but it works for now */

 extern flash_info_t flash_info[];	/* info for FLASH chips */

 static int
 mpl_prg(uchar *src, ulong size)
 {
 	ulong start;
 	flash_info_t *info;
 	int i, rc;
 #if defined(CONFIG_PATI)
 	int start_sect;
 #endif
 #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI)
 	char *copystr = (char *)src;
 	ulong *magic = (ulong *)src;
 #endif

 	info = &flash_info[0];

 #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI)
 	if (uimage_to_cpu (magic[0]) != IH_MAGIC) {
 		puts("Bad Magic number\n");
 		return -1;
 	}
 	/* some more checks before we delete the Flash... */
 	/* Checking the ISO_STRING prevents to program a
 	 * wrong Firmware Image into the flash.
 	 */
 	i = 4; /* skip Magic number */
 	while (1) {
 		if (strncmp(&copystr[i], "MEV-", 4) == 0)
 			break;
 		if (i++ >= 0x100) {
 			puts("Firmware Image for unknown Target\n");
 			return -1;
 		}
 	}
 	/* we have the ISO STRING, check */
 	if (strncmp(&copystr[i], CONFIG_ISO_STRING, sizeof(CONFIG_ISO_STRING)-1) != 0) {
 		printf("Wrong Firmware Image: %s\n", &copystr[i]);
 		return -1;
 	}
 #if !defined(CONFIG_PATI)
 	start = 0 - size;
 	for (i = info->sector_count-1; i > 0; i--) {
 		info->protect[i] = 0; /* unprotect this sector */
 		if (start >= info->start[i])
 			break;
 	}
 	/* set-up flash location */
 	/* now erase flash */
 	printf("Erasing at %lx (sector %d) (start %lx)\n",
 				start,i,info->start[i]);
 	if ((rc = flash_erase (info, i, info->sector_count-1)) != 0) {
 		puts("ERROR ");
 		flash_perror(rc);
 		return (1);
 	}

 #else /* #if !defined(CONFIG_PATI */
 	start = FIRM_START;
 	start_sect = -1;
 	for (i = 0; i < info->sector_count; i++) {
 		if (start < info->start[i]) {
 			start_sect = i - 1;
 			break;
 		}
 	}

 	info->protect[i - 1] = 0;	/* unprotect this sector */
 	for (; i < info->sector_count; i++) {
 		if ((start + size) < info->start[i])
 			break;
 		info->protect[i] = 0;	/* unprotect this sector */
 	}

 	i--;
 	/* set-up flash location */
 	/* now erase flash */
 	printf ("Erasing at %lx to %lx (sector %d to %d) (%lx to %lx)\n",
 		start, start + size, start_sect, i,
 		info->start[start_sect], info->start[i]);
 	if ((rc = flash_erase (info, start_sect, i)) != 0) {
 		puts ("ERROR ");
 		flash_perror (rc);
 		return (1);
 	}
 #endif /* defined(CONFIG_PATI) */

 #elif defined(CONFIG_VCMA9)
 	start = 0;
 	for (i = 0; i <info->sector_count; i++) {
 		info->protect[i] = 0; /* unprotect this sector */
 		if (size < info->start[i])
 		    break;
 	}
 	/* set-up flash location */
 	/* now erase flash */
 	printf("Erasing at %lx (sector %d) (start %lx)\n",
 				start,0,info->start[0]);
 	if ((rc = flash_erase (info, 0, i)) != 0) {
 		puts("ERROR ");
 		flash_perror(rc);
 		return (1);
 	}

 #endif
 	printf("flash erased, programming from 0x%lx 0x%lx Bytes\n",
 		(ulong)src, size);
 	if ((rc = flash_write ((char *)src, start, size)) != 0) {
 		puts("ERROR ");
 		flash_perror(rc);
 		return (1);
 	}
 	puts("OK programming done\n");
 	return 0;
 }


 static int
 mpl_prg_image(uchar *ld_addr)
 {
 	unsigned long len;
 	uchar *data;
 	image_header_t *hdr = (image_header_t *)ld_addr;
 	int rc;

 #if defined(CONFIG_FIT)
 	if (genimg_get_format ((void *)hdr) != IMAGE_FORMAT_LEGACY) {
 		puts ("Non legacy image format not supported\n");
 		return -1;
 	}
 #endif

 	if (!image_check_magic (hdr)) {
 		puts("Bad Magic Number\n");
 		return 1;
 	}
 	image_print_contents (hdr);
 	if (!image_check_os (hdr, IH_OS_U_BOOT)) {
 		puts("No U-Boot Image\n");
 		return 1;
 	}
 	if (!image_check_type (hdr, IH_TYPE_FIRMWARE)) {
 		puts("No Firmware Image\n");
 		return 1;
 	}
 	if (!image_check_hcrc (hdr)) {
 		puts("Bad Header Checksum\n");
 		return 1;
 	}
 	puts("Verifying Checksum ... ");
 	if (!image_check_dcrc (hdr)) {
 		puts("Bad Data CRC\n");
 		return 1;
 	}
 	puts("OK\n");

 	data = (uchar *)image_get_data (hdr);
 	len = image_get_data_size (hdr);

 	if (image_get_comp (hdr) != IH_COMP_NONE) {
 		uchar *buf;
 		/* reserve space for uncompressed image */
 		if ((buf = malloc(IMAGE_SIZE)) == NULL) {
 			puts("Insufficient space for decompression\n");
 			return 1;
 		}

 		switch (image_get_comp (hdr)) {
 		case IH_COMP_GZIP:
 			puts("Uncompressing (GZIP) ... ");
 			rc = gunzip ((void *)(buf), IMAGE_SIZE, data, &len);
 			if (rc != 0) {
 				puts("GUNZIP ERROR\n");
 				free(buf);
 				return 1;
 			}
 			puts("OK\n");
 			break;
 #ifdef CONFIG_BZIP2
 		case IH_COMP_BZIP2:
 			puts("Uncompressing (BZIP2) ... ");
 			{
 			uint retlen = IMAGE_SIZE;
 			rc = BZ2_bzBuffToBuffDecompress ((char *)(buf), &retlen,
 				(char *)data, len, 0, 0);
 			len = retlen;
 			}
 			if (rc != BZ_OK) {
 				printf ("BUNZIP2 ERROR: %d\n", rc);
 				free(buf);
 				return 1;
 			}
 			puts("OK\n");
 			break;
 #endif
 		default:
 			printf ("Unimplemented compression type %d\n",
 				image_get_comp (hdr));
 			free(buf);
 			return 1;
 		}

 		rc = mpl_prg(buf, len);
 		free(buf);
 	} else {
 		rc = mpl_prg(data, len);
 	}

 	return(rc);
 }

 #if !defined(CONFIG_PATI)
 void get_backup_values(backup_t *buf)
 {
 	i2c_read(CFG_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)buf,sizeof(backup_t));
 }

 void set_backup_values(int overwrite)
 {
 	backup_t back;
 	int i;

 	get_backup_values(&back);
 	if(!overwrite) {
 		if(strncmp(back.signature,"MPL\0",4)==0) {
 			puts("Not possible to write Backup\n");
 			return;
 		}
 	}
 	memcpy(back.signature,"MPL\0",4);
 	i = getenv_r("serial#",back.serial_name,16);
 	if(i < 0) {
 		puts("Not possible to write Backup\n");
 		return;
 	}
 	back.serial_name[16]=0;
 	i = getenv_r("ethaddr",back.eth_addr,20);
 	if(i < 0) {
 		puts("Not possible to write Backup\n");
 		return;
 	}
 	back.eth_addr[20]=0;
 	i2c_write(CFG_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t));
 }

 void clear_env_values(void)
 {
 	backup_t back;
 	unsigned char env_crc[4];

 	memset(&back,0xff,sizeof(backup_t));
 	memset(env_crc,0x00,4);
 	i2c_write(CFG_DEF_EEPROM_ADDR,I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t));
 	i2c_write(CFG_DEF_EEPROM_ADDR,CFG_ENV_OFFSET,2,(void *)env_crc,4);
 }

 /*
  * check crc of "older" environment
  */
 int check_env_old_size(ulong oldsize)
 {
 	ulong crc, len, new;
 	unsigned off;
 	uchar buf[64];

 	/* read old CRC */
 	eeprom_read (CFG_DEF_EEPROM_ADDR,
 		     CFG_ENV_OFFSET,
 		     (uchar *)&crc, sizeof(ulong));

 	new = 0;
 	len = oldsize;
 	off = sizeof(long);
 	len = oldsize-off;
 	while (len > 0) {
 		int n = (len > sizeof(buf)) ? sizeof(buf) : len;

 		eeprom_read (CFG_DEF_EEPROM_ADDR, CFG_ENV_OFFSET+off, buf, n);
 		new = crc32 (new, buf, n);
 		len -= n;
 		off += n;
 	}

 	return (crc == new);
 }

 static ulong oldsizes[] = {
 	0x200,
 	0x800,
 	0
 };

 void copy_old_env(ulong size)
 {
 	uchar name_buf[64];
 	uchar value_buf[0x800];
 	uchar c;
 	ulong len;
 	unsigned off;
 	uchar *name, *value;

 	name = &name_buf[0];
 	value = &value_buf[0];
 	len=size;
 	off = sizeof(long);
 	while (len > off) {
 		eeprom_read (CFG_DEF_EEPROM_ADDR, CFG_ENV_OFFSET+off, &c, 1);
 		if(c != '=') {
 			*name++=c;
 			off++;
 		}
 		else {
 			*name++='\0';
 			off++;
 			do {
 				eeprom_read (CFG_DEF_EEPROM_ADDR, CFG_ENV_OFFSET+off, &c, 1);
 				*value++=c;
 				off++;
 				if(c == '\0')
 					break;
 			} while(len > off);
 			name = &name_buf[0];
 			value = &value_buf[0];
 			if(strncmp((char *)name,"baudrate",8)!=0) {
 				setenv((char *)name,(char *)value);
 			}

 		}
 	}
 }


 void check_env(void)
 {
 	char *s;
 	int i=0;
 	char buf[32];
 	backup_t back;

 	s=getenv("serial#");
 	if(!s) {
 		while(oldsizes[i]) {
 			if(check_env_old_size(oldsizes[i]))
 				break;
 			i++;
 		}
 		if(!oldsizes[i]) {
 			/* no old environment has been found */
 			get_backup_values (&back);
 			if (strncmp (back.signature, "MPL\0", 4) == 0) {
 				sprintf (buf, "%s", back.serial_name);
 				setenv ("serial#", buf);
 				sprintf (buf, "%s", back.eth_addr);
 				setenv ("ethaddr", buf);
 				printf ("INFO:  serial# and ethaddr recovered, use saveenv\n");
 				return;
 			}
 		}
 		else {
 			copy_old_env(oldsizes[i]);
 			puts("INFO:  old environment ajusted, use saveenv\n");
 		}
 	}
 	else {
 		/* check if back up is set */
 		get_backup_values(&back);
 		if(strncmp(back.signature,"MPL\0",4)!=0) {
 			set_backup_values(0);
 		}
 	}
 }


 extern device_t *stdio_devices[];
 extern char *stdio_names[];

 void show_stdio_dev(void)
 {
 	/* Print information */
 	puts("In:    ");
 	if (stdio_devices[stdin] == NULL) {
 		puts("No input devices available!\n");
 	} else {
 		printf ("%s\n", stdio_devices[stdin]->name);
 	}

 	puts("Out:   ");
 	if (stdio_devices[stdout] == NULL) {
 		puts("No output devices available!\n");
 	} else {
 		printf ("%s\n", stdio_devices[stdout]->name);
 	}

 	puts("Err:   ");
 	if (stdio_devices[stderr] == NULL) {
 		puts("No error devices available!\n");
 	} else {
 		printf ("%s\n", stdio_devices[stderr]->name);
 	}
 }

 #endif /* #if !defined(CONFIG_PATI) */

 int do_mplcommon(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 {
 	ulong size,src,ld_addr;
 	int result;
 #if !defined(CONFIG_PATI)
 	backup_t back;
 	src = MULTI_PURPOSE_SOCKET_ADDR;
 	size = IMAGE_SIZE;
 #endif

 	if (strcmp(argv[1], "flash") == 0)
 	{
 #if defined(CONFIG_CMD_FDC)
 		if (strcmp(argv[2], "floppy") == 0) {
 			char *local_args[3];
 			extern int do_fdcboot (cmd_tbl_t *, int, int, char *[]);
 			puts("\nupdating bootloader image from floppy\n");
 			local_args[0] = argv[0];
 			if(argc==4) {
 				local_args[1] = argv[3];
 				local_args[2] = NULL;
 				ld_addr=simple_strtoul(argv[3], NULL, 16);
 				result=do_fdcboot(cmdtp, 0, 2, local_args);
 			}
 			else {
 				local_args[1] = NULL;
 				ld_addr=CFG_LOAD_ADDR;
 				result=do_fdcboot(cmdtp, 0, 1, local_args);
 			}
 			result=mpl_prg_image((uchar *)ld_addr);
 			return result;
 		}
 #endif
 		if (strcmp(argv[2], "mem") == 0) {
 			if(argc==4) {
 				ld_addr=simple_strtoul(argv[3], NULL, 16);
 			}
 			else {
 				ld_addr=load_addr;
 			}
 			printf ("\nupdating bootloader image from memory at %lX\n",ld_addr);
 			result=mpl_prg_image((uchar *)ld_addr);
 			return result;
 		}
 #if !defined(CONFIG_PATI)
 		if (strcmp(argv[2], "mps") == 0) {
 			puts("\nupdating bootloader image from MPS\n");
 			result=mpl_prg((uchar *)src,size);
 			return result;
 		}
 #endif /* #if !defined(CONFIG_PATI)	*/
 	}
 	if (strcmp(argv[1], "mem") == 0)
 	{
 		result=0;
 		if(argc==3)
 		{
 			result = (int)simple_strtol(argv[2], NULL, 16);
 	    }
 	    src=(unsigned long)&result;
 	    src-=CFG_MEMTEST_START;
 	    src-=(100*1024); /* - 100k */
 	    src&=0xfff00000;
 	    size=0;
 	    do {
 		size++;
 			printf("\n\nPass %ld\n",size);
 			mem_test(CFG_MEMTEST_START,src,1);
 			if(ctrlc())
 				break;
 			if(result>0)
 				result--;

 		}while(result);
 		return 0;
 	}
 #if !defined(CONFIG_PATI)
 	if (strcmp(argv[1], "clearenvvalues") == 0)
 	{
 		if (strcmp(argv[2], "yes") == 0)
 		{
 			clear_env_values();
 			return 0;
 		}
 	}
 	if (strcmp(argv[1], "getback") == 0) {
 		get_backup_values(&back);
 		back.signature[3]=0;
 		back.serial_name[16]=0;
 		back.eth_addr[20]=0;
 		printf("GetBackUp: signature: %s\n",back.signature);
 		printf("           serial#:   %s\n",back.serial_name);
 		printf("           ethaddr:   %s\n",back.eth_addr);
 		return 0;
 	}
 	if (strcmp(argv[1], "setback") == 0) {
 		set_backup_values(1);
 		return 0;
 	}
 #endif
 	printf("Usage:\n%s\n", cmdtp->usage);
 	return 1;
 }


 #if defined(CONFIG_CMD_DOC)
 extern void doc_probe(ulong physadr);
 void doc_init (void)
 {
   doc_probe(MULTI_PURPOSE_SOCKET_ADDR);
 }
 #endif


 #ifdef CONFIG_VIDEO
 /******************************************************
  * Routines to display the Board information
  * to the screen (since the VGA will be initialized as last,
  * we must resend the infos)
  */

 #ifdef CONFIG_CONSOLE_EXTRA_INFO
 extern GraphicDevice ctfb;
 extern int get_boot_mode(void);

 void video_get_info_str (int line_number, char *info)
 {
 	/* init video info strings for graphic console */
 	PPC4xx_SYS_INFO sys_info;
 	char rev;
 	int i,boot;
 	unsigned long pvr;
 	char buf[64];
 	char tmp[16];
 	char cpustr[16];
 	char *s, *e, bc;
 	switch (line_number)
 	{
 	case 2:
 		/* CPU and board infos */
 		pvr=get_pvr();
 		get_sys_info (&sys_info);
 		switch (pvr) {
 			case PVR_405GP_RB: rev='B'; break;
 			case PVR_405GP_RC: rev='C'; break;
 			case PVR_405GP_RD: rev='D'; break;
 			case PVR_405GP_RE: rev='E'; break;
 			case PVR_405GPR_RB: rev='B'; break;
 			default:           rev='?'; break;
 		}
 		if(pvr==PVR_405GPR_RB)
 			sprintf(cpustr,"PPC405GPr %c",rev);
 		else
 			sprintf(cpustr,"PPC405GP %c",rev);
 		/* Board info */
 		i=0;
 		s=getenv ("serial#");
 #ifdef CONFIG_PIP405
 		if (!s || strncmp (s, "PIP405", 6)) {
 			sprintf(buf,"### No HW ID - assuming PIP405");
 		}
 #endif
 #ifdef CONFIG_MIP405
 		if (!s || strncmp (s, "MIP405", 6)) {
 			sprintf(buf,"### No HW ID - assuming MIP405");
 		}
 #endif
 		else {
 			for (e = s; *e; ++e) {
 				if (*e == ' ')
 					break;
 			}
 			for (; s < e; ++s) {
 				if (*s == '_') {
 					++s;
 					break;
 				}
 				buf[i++] = *s;
 			}
 			sprintf(&buf[i]," SN ");
 			i+=4;
 			for (; s < e; ++s) {
 				buf[i++] = *s;
 			}
 			buf[i++]=0;
 		}
 		sprintf (info," %s %s %s MHz (%lu/%lu/%lu MHz)",
 			buf, cpustr,
 			strmhz (tmp, gd->cpu_clk), sys_info.freqPLB / 1000000,
 			sys_info.freqPLB / sys_info.pllOpbDiv / 1000000,
 			sys_info.freqPLB / sys_info.pllExtBusDiv / 1000000);
 		return;
 	case 3:
 		/* Memory Info */
 		boot = get_boot_mode();
 		bc = in8 (CONFIG_PORT_ADDR);
 		sprintf(info, " %luMB RAM, %luMB Flash Cfg 0x%02X %s %s",
 			gd->bd->bi_memsize / 0x100000,
 			gd->bd->bi_flashsize / 0x100000,
 			bc,
 			(boot & BOOT_MPS) ? "MPS boot" : "Flash boot",
 			ctfb.modeIdent);
 		return;
 	case 1:
 		sprintf	(buf, "%s",CONFIG_IDENT_STRING);
 		sprintf (info, " %s", &buf[1]);
 		return;
     }
     /* no more info lines */
     *info = 0;
     return;
 }
 #endif /* CONFIG_CONSOLE_EXTRA_INFO */

 #endif /* CONFIG_VIDEO */
	/*
	* (C) Copyright 2001
	* Denis Peter, MPL AG Switzerland, d.peter@mpl.ch
	*
	* 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
	*
	*/

	#include <common.h>
	#include <command.h>
	#include <video_fb.h>
	#include "common_util.h"
	#include <asm/processor.h>
	#include <asm/byteorder.h>
	#include <i2c.h>
	#include <devices.h>
	#include <pci.h>
	#include <malloc.h>
	#include <bzlib.h>

	#ifdef CONFIG_PIP405
	#include "../pip405/pip405.h"
	#include <asm/4xx_pci.h>
	#endif
	#ifdef CONFIG_MIP405
	#include "../mip405/mip405.h"
	#include <asm/4xx_pci.h>
	#endif

	DECLARE_GLOBAL_DATA_PTR;

	#if defined(CONFIG_PATI)
	#define FIRM_START 0xFFF00000
	#endif

	extern int gunzip(void , int, uchar , unsigned long *);
	extern int mem_test(ulong start, ulong ramsize, int quiet);

	#define I2C_BACKUP_ADDR 0x7C00 /* 0x200 bytes for backup */
	#define IMAGE_SIZE CFG_MONITOR_LEN /* ugly, but it works for now */

	extern flash_info_t flash_info[]; /* info for FLASH chips */

	static int
	mpl_prg(uchar *src, ulong size)
	{
	ulong start;
	flash_info_t *info;
	int i, rc;
	#if defined(CONFIG_PATI)
	int start_sect;
	#endif
	#if defined(CONFIG_PIP405) \|\| defined(CONFIG_MIP405) \|\| defined(CONFIG_PATI)
	char copystr = (char )src;
	ulong magic = (ulong )src;
	#endif

	info = &flash_info[0];

	#if defined(CONFIG_PIP405) \|\| defined(CONFIG_MIP405) \|\| defined(CONFIG_PATI)
	if (uimage_to_cpu (magic[0]) != IH_MAGIC) {
	puts("Bad Magic number\n");
	return -1;
	}
	/* some more checks before we delete the Flash... */
	/* Checking the ISO_STRING prevents to program a
	* wrong Firmware Image into the flash.
	*/
	i = 4; /* skip Magic number */
	while (1) {
	if (strncmp(&copystr[i], "MEV-", 4) == 0)
	break;
	if (i++ >= 0x100) {
	puts("Firmware Image for unknown Target\n");
	return -1;
	}
	}
	/* we have the ISO STRING, check */
	if (strncmp(&copystr[i], CONFIG_ISO_STRING, sizeof(CONFIG_ISO_STRING)-1) != 0) {
	printf("Wrong Firmware Image: %s\n", &copystr[i]);
	return -1;
	}
	#if !defined(CONFIG_PATI)
	start = 0 - size;
	for (i = info->sector_count-1; i > 0; i--) {
	info->protect[i] = 0; /* unprotect this sector */
	if (start >= info->start[i])
	break;
	}
	/* set-up flash location */
	/* now erase flash */
	printf("Erasing at %lx (sector %d) (start %lx)\n",
	start,i,info->start[i]);
	if ((rc = flash_erase (info, i, info->sector_count-1)) != 0) {
	puts("ERROR ");
	flash_perror(rc);
	return (1);
	}

	#else /* #if !defined(CONFIG_PATI */
	start = FIRM_START;
	start_sect = -1;
	for (i = 0; i < info->sector_count; i++) {
	if (start < info->start[i]) {
	start_sect = i - 1;
	break;
	}
	}

	info->protect[i - 1] = 0; /* unprotect this sector */
	for (; i < info->sector_count; i++) {
	if ((start + size) < info->start[i])
	break;
	info->protect[i] = 0; /* unprotect this sector */
	}

	i--;
	/* set-up flash location */
	/* now erase flash */
	printf ("Erasing at %lx to %lx (sector %d to %d) (%lx to %lx)\n",
	start, start + size, start_sect, i,
	info->start[start_sect], info->start[i]);
	if ((rc = flash_erase (info, start_sect, i)) != 0) {
	puts ("ERROR ");
	flash_perror (rc);
	return (1);
	}
	#endif /* defined(CONFIG_PATI) */

	#elif defined(CONFIG_VCMA9)
	start = 0;
	for (i = 0; i <info->sector_count; i++) {
	info->protect[i] = 0; /* unprotect this sector */
	if (size < info->start[i])
	break;
	}
	/* set-up flash location */
	/* now erase flash */
	printf("Erasing at %lx (sector %d) (start %lx)\n",
	start,0,info->start[0]);
	if ((rc = flash_erase (info, 0, i)) != 0) {
	puts("ERROR ");
	flash_perror(rc);
	return (1);
	}

	#endif
	printf("flash erased, programming from 0x%lx 0x%lx Bytes\n",
	(ulong)src, size);
	if ((rc = flash_write ((char *)src, start, size)) != 0) {
	puts("ERROR ");
	flash_perror(rc);
	return (1);
	}
	puts("OK programming done\n");
	return 0;
	}


	static int
	mpl_prg_image(uchar *ld_addr)
	{
	unsigned long len;
	uchar *data;
	image_header_t hdr = (image_header_t )ld_addr;
	int rc;

	#if defined(CONFIG_FIT)
	if (genimg_get_format ((void *)hdr) != IMAGE_FORMAT_LEGACY) {
	puts ("Non legacy image format not supported\n");
	return -1;
	}
	#endif

	if (!image_check_magic (hdr)) {
	puts("Bad Magic Number\n");
	return 1;
	}
	image_print_contents (hdr);
	if (!image_check_os (hdr, IH_OS_U_BOOT)) {
	puts("No U-Boot Image\n");
	return 1;
	}
	if (!image_check_type (hdr, IH_TYPE_FIRMWARE)) {
	puts("No Firmware Image\n");
	return 1;
	}
	if (!image_check_hcrc (hdr)) {
	puts("Bad Header Checksum\n");
	return 1;
	}
	puts("Verifying Checksum ... ");
	if (!image_check_dcrc (hdr)) {
	puts("Bad Data CRC\n");
	return 1;
	}
	puts("OK\n");

	data = (uchar *)image_get_data (hdr);
	len = image_get_data_size (hdr);

	if (image_get_comp (hdr) != IH_COMP_NONE) {
	uchar *buf;
	/* reserve space for uncompressed image */
	if ((buf = malloc(IMAGE_SIZE)) == NULL) {
	puts("Insufficient space for decompression\n");
	return 1;
	}

	switch (image_get_comp (hdr)) {
	case IH_COMP_GZIP:
	puts("Uncompressing (GZIP) ... ");
	rc = gunzip ((void *)(buf), IMAGE_SIZE, data, &len);
	if (rc != 0) {
	puts("GUNZIP ERROR\n");
	free(buf);
	return 1;
	}
	puts("OK\n");
	break;
	#ifdef CONFIG_BZIP2
	case IH_COMP_BZIP2:
	puts("Uncompressing (BZIP2) ... ");
	{
	uint retlen = IMAGE_SIZE;
	rc = BZ2_bzBuffToBuffDecompress ((char *)(buf), &retlen,
	(char *)data, len, 0, 0);
	len = retlen;
	}
	if (rc != BZ_OK) {
	printf ("BUNZIP2 ERROR: %d\n", rc);
	free(buf);
	return 1;
	}
	puts("OK\n");
	break;
	#endif
	default:
	printf ("Unimplemented compression type %d\n",
	image_get_comp (hdr));
	free(buf);
	return 1;
	}

	rc = mpl_prg(buf, len);
	free(buf);
	} else {
	rc = mpl_prg(data, len);
	}

	return(rc);
	}

	#if !defined(CONFIG_PATI)
	void get_backup_values(backup_t *buf)
	{
	i2c_read(CFG_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)buf,sizeof(backup_t));
	}

	void set_backup_values(int overwrite)
	{
	backup_t back;
	int i;

	get_backup_values(&back);
	if(!overwrite) {
	if(strncmp(back.signature,"MPL\0",4)==0) {
	puts("Not possible to write Backup\n");
	return;
	}
	}
	memcpy(back.signature,"MPL\0",4);
	i = getenv_r("serial#",back.serial_name,16);
	if(i < 0) {
	puts("Not possible to write Backup\n");
	return;
	}
	back.serial_name[16]=0;
	i = getenv_r("ethaddr",back.eth_addr,20);
	if(i < 0) {
	puts("Not possible to write Backup\n");
	return;
	}
	back.eth_addr[20]=0;
	i2c_write(CFG_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t));
	}

	void clear_env_values(void)
	{
	backup_t back;
	unsigned char env_crc[4];

	memset(&back,0xff,sizeof(backup_t));
	memset(env_crc,0x00,4);
	i2c_write(CFG_DEF_EEPROM_ADDR,I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t));
	i2c_write(CFG_DEF_EEPROM_ADDR,CFG_ENV_OFFSET,2,(void *)env_crc,4);
	}

	/*
	* check crc of "older" environment
	*/
	int check_env_old_size(ulong oldsize)
	{
	ulong crc, len, new;
	unsigned off;
	uchar buf[64];

	/* read old CRC */
	eeprom_read (CFG_DEF_EEPROM_ADDR,
	CFG_ENV_OFFSET,
	(uchar *)&crc, sizeof(ulong));

	new = 0;
	len = oldsize;
	off = sizeof(long);
	len = oldsize-off;
	while (len > 0) {
	int n = (len > sizeof(buf)) ? sizeof(buf) : len;

	eeprom_read (CFG_DEF_EEPROM_ADDR, CFG_ENV_OFFSET+off, buf, n);
	new = crc32 (new, buf, n);
	len -= n;
	off += n;
	}

	return (crc == new);
	}

	static ulong oldsizes[] = {
	0x200,
	0x800,
	0
	};

	void copy_old_env(ulong size)
	{
	uchar name_buf[64];
	uchar value_buf[0x800];
	uchar c;
	ulong len;
	unsigned off;
	uchar name, value;

	name = &name_buf[0];
	value = &value_buf[0];
	len=size;
	off = sizeof(long);
	while (len > off) {
	eeprom_read (CFG_DEF_EEPROM_ADDR, CFG_ENV_OFFSET+off, &c, 1);
	if(c != '=') {
	*name++=c;
	off++;
	}
	else {
	*name++='\0';
	off++;
	do {
	eeprom_read (CFG_DEF_EEPROM_ADDR, CFG_ENV_OFFSET+off, &c, 1);
	*value++=c;
	off++;
	if(c == '\0')
	break;
	} while(len > off);
	name = &name_buf[0];
	value = &value_buf[0];
	if(strncmp((char *)name,"baudrate",8)!=0) {
	setenv((char )name,(char )value);
	}

	}
	}
	}


	void check_env(void)
	{
	char *s;
	int i=0;
	char buf[32];
	backup_t back;

	s=getenv("serial#");
	if(!s) {
	while(oldsizes[i]) {
	if(check_env_old_size(oldsizes[i]))
	break;
	i++;
	}
	if(!oldsizes[i]) {
	/* no old environment has been found */
	get_backup_values (&back);
	if (strncmp (back.signature, "MPL\0", 4) == 0) {
	sprintf (buf, "%s", back.serial_name);
	setenv ("serial#", buf);
	sprintf (buf, "%s", back.eth_addr);
	setenv ("ethaddr", buf);
	printf ("INFO: serial# and ethaddr recovered, use saveenv\n");
	return;
	}
	}
	else {
	copy_old_env(oldsizes[i]);
	puts("INFO: old environment ajusted, use saveenv\n");
	}
	}
	else {
	/* check if back up is set */
	get_backup_values(&back);
	if(strncmp(back.signature,"MPL\0",4)!=0) {
	set_backup_values(0);
	}
	}
	}


	extern device_t *stdio_devices[];
	extern char *stdio_names[];

	void show_stdio_dev(void)
	{
	/* Print information */
	puts("In: ");
	if (stdio_devices[stdin] == NULL) {
	puts("No input devices available!\n");
	} else {
	printf ("%s\n", stdio_devices[stdin]->name);
	}

	puts("Out: ");
	if (stdio_devices[stdout] == NULL) {
	puts("No output devices available!\n");
	} else {
	printf ("%s\n", stdio_devices[stdout]->name);
	}

	puts("Err: ");
	if (stdio_devices[stderr] == NULL) {
	puts("No error devices available!\n");
	} else {
	printf ("%s\n", stdio_devices[stderr]->name);
	}
	}

	#endif /* #if !defined(CONFIG_PATI) */

	int do_mplcommon(cmd_tbl_t cmdtp, int flag, int argc, char argv[])
	{
	ulong size,src,ld_addr;
	int result;
	#if !defined(CONFIG_PATI)
	backup_t back;
	src = MULTI_PURPOSE_SOCKET_ADDR;
	size = IMAGE_SIZE;
	#endif

	if (strcmp(argv[1], "flash") == 0)
	{
	#if defined(CONFIG_CMD_FDC)
	if (strcmp(argv[2], "floppy") == 0) {
	char *local_args[3];
	extern int do_fdcboot (cmd_tbl_t , int, int, char []);
	puts("\nupdating bootloader image from floppy\n");
	local_args[0] = argv[0];
	if(argc==4) {
	local_args[1] = argv[3];
	local_args[2] = NULL;
	ld_addr=simple_strtoul(argv[3], NULL, 16);
	result=do_fdcboot(cmdtp, 0, 2, local_args);
	}
	else {
	local_args[1] = NULL;
	ld_addr=CFG_LOAD_ADDR;
	result=do_fdcboot(cmdtp, 0, 1, local_args);
	}
	result=mpl_prg_image((uchar *)ld_addr);
	return result;
	}
	#endif
	if (strcmp(argv[2], "mem") == 0) {
	if(argc==4) {
	ld_addr=simple_strtoul(argv[3], NULL, 16);
	}
	else {
	ld_addr=load_addr;
	}
	printf ("\nupdating bootloader image from memory at %lX\n",ld_addr);
	result=mpl_prg_image((uchar *)ld_addr);
	return result;
	}
	#if !defined(CONFIG_PATI)
	if (strcmp(argv[2], "mps") == 0) {
	puts("\nupdating bootloader image from MPS\n");
	result=mpl_prg((uchar *)src,size);
	return result;
	}
	#endif /* #if !defined(CONFIG_PATI) */
	}
	if (strcmp(argv[1], "mem") == 0)
	{
	result=0;
	if(argc==3)
	{
	result = (int)simple_strtol(argv[2], NULL, 16);
	}
	src=(unsigned long)&result;
	src-=CFG_MEMTEST_START;
	src-=(1001024); / - 100k */
	src&=0xfff00000;
	size=0;
	do {
	size++;
	printf("\n\nPass %ld\n",size);
	mem_test(CFG_MEMTEST_START,src,1);
	if(ctrlc())
	break;
	if(result>0)
	result--;

	}while(result);
	return 0;
	}
	#if !defined(CONFIG_PATI)
	if (strcmp(argv[1], "clearenvvalues") == 0)
	{
	if (strcmp(argv[2], "yes") == 0)
	{
	clear_env_values();
	return 0;
	}
	}
	if (strcmp(argv[1], "getback") == 0) {
	get_backup_values(&back);
	back.signature[3]=0;
	back.serial_name[16]=0;
	back.eth_addr[20]=0;
	printf("GetBackUp: signature: %s\n",back.signature);
	printf(" serial#: %s\n",back.serial_name);
	printf(" ethaddr: %s\n",back.eth_addr);
	return 0;
	}
	if (strcmp(argv[1], "setback") == 0) {
	set_backup_values(1);
	return 0;
	}
	#endif
	printf("Usage:\n%s\n", cmdtp->usage);
	return 1;
	}


	#if defined(CONFIG_CMD_DOC)
	extern void doc_probe(ulong physadr);
	void doc_init (void)
	{
	doc_probe(MULTI_PURPOSE_SOCKET_ADDR);
	}
	#endif


	#ifdef CONFIG_VIDEO
	/******************************************************
	* Routines to display the Board information
	* to the screen (since the VGA will be initialized as last,
	* we must resend the infos)
	*/

	#ifdef CONFIG_CONSOLE_EXTRA_INFO
	extern GraphicDevice ctfb;
	extern int get_boot_mode(void);

	void video_get_info_str (int line_number, char *info)
	{
	/* init video info strings for graphic console */
	PPC4xx_SYS_INFO sys_info;
	char rev;
	int i,boot;
	unsigned long pvr;
	char buf[64];
	char tmp[16];
	char cpustr[16];
	char s, e, bc;
	switch (line_number)
	{
	case 2:
	/* CPU and board infos */
	pvr=get_pvr();
	get_sys_info (&sys_info);
	switch (pvr) {
	case PVR_405GP_RB: rev='B'; break;
	case PVR_405GP_RC: rev='C'; break;
	case PVR_405GP_RD: rev='D'; break;
	case PVR_405GP_RE: rev='E'; break;
	case PVR_405GPR_RB: rev='B'; break;
	default: rev='?'; break;
	}
	if(pvr==PVR_405GPR_RB)
	sprintf(cpustr,"PPC405GPr %c",rev);
	else
	sprintf(cpustr,"PPC405GP %c",rev);
	/* Board info */
	i=0;
	s=getenv ("serial#");
	#ifdef CONFIG_PIP405
	if (!s \|\| strncmp (s, "PIP405", 6)) {
	sprintf(buf,"### No HW ID - assuming PIP405");
	}
	#endif
	#ifdef CONFIG_MIP405
	if (!s \|\| strncmp (s, "MIP405", 6)) {
	sprintf(buf,"### No HW ID - assuming MIP405");
	}
	#endif
	else {
	for (e = s; *e; ++e) {
	if (*e == ' ')
	break;
	}
	for (; s < e; ++s) {
	if (*s == '_') {
	++s;
	break;
	}
	buf[i++] = *s;
	}
	sprintf(&buf[i]," SN ");
	i+=4;
	for (; s < e; ++s) {
	buf[i++] = *s;
	}
	buf[i++]=0;
	}
	sprintf (info," %s %s %s MHz (%lu/%lu/%lu MHz)",
	buf, cpustr,
	strmhz (tmp, gd->cpu_clk), sys_info.freqPLB / 1000000,
	sys_info.freqPLB / sys_info.pllOpbDiv / 1000000,
	sys_info.freqPLB / sys_info.pllExtBusDiv / 1000000);
	return;
	case 3:
	/* Memory Info */
	boot = get_boot_mode();
	bc = in8 (CONFIG_PORT_ADDR);
	sprintf(info, " %luMB RAM, %luMB Flash Cfg 0x%02X %s %s",
	gd->bd->bi_memsize / 0x100000,
	gd->bd->bi_flashsize / 0x100000,
	bc,
	(boot & BOOT_MPS) ? "MPS boot" : "Flash boot",
	ctfb.modeIdent);
	return;
	case 1:
	sprintf (buf, "%s",CONFIG_IDENT_STRING);
	sprintf (info, " %s", &buf[1]);
	return;
	}
	/* no more info lines */
	*info = 0;
	return;
	}
	#endif /* CONFIG_CONSOLE_EXTRA_INFO */

	#endif /* CONFIG_VIDEO */