3 * Denis Peter, MPL AG Switzerland, d.peter@mpl.ch
5 * See file CREDITS for list of people who contributed to this
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of
11 * the License, or (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
28 #include "common_util.h"
29 #include <asm/processor.h>
30 #include <asm/byteorder.h>
37 #include "../pip405/pip405.h"
38 #include <asm/4xx_pci.h>
41 #include "../mip405/mip405.h"
42 #include <asm/4xx_pci.h>
45 DECLARE_GLOBAL_DATA_PTR;
47 #if defined(CONFIG_PATI)
48 #define FIRM_START 0xFFF00000
51 extern int gunzip(void *, int, uchar *, unsigned long *);
52 extern int mem_test(ulong start, ulong ramsize, int quiet);
54 #define I2C_BACKUP_ADDR 0x7C00 /* 0x200 bytes for backup */
55 #define IMAGE_SIZE CONFIG_SYS_MONITOR_LEN /* ugly, but it works for now */
57 extern flash_info_t flash_info[]; /* info for FLASH chips */
60 mpl_prg(uchar *src, ulong size)
65 #if defined(CONFIG_PATI)
68 #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI)
69 char *copystr = (char *)src;
70 ulong *magic = (ulong *)src;
73 info = &flash_info[0];
75 #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI)
76 if (uimage_to_cpu (magic[0]) != IH_MAGIC) {
77 puts("Bad Magic number\n");
80 /* some more checks before we delete the Flash... */
81 /* Checking the ISO_STRING prevents to program a
82 * wrong Firmware Image into the flash.
84 i = 4; /* skip Magic number */
86 if (strncmp(©str[i], "MEV-", 4) == 0)
89 puts("Firmware Image for unknown Target\n");
93 /* we have the ISO STRING, check */
94 if (strncmp(©str[i], CONFIG_ISO_STRING, sizeof(CONFIG_ISO_STRING)-1) != 0) {
95 printf("Wrong Firmware Image: %s\n", ©str[i]);
98 #if !defined(CONFIG_PATI)
100 for (i = info->sector_count-1; i > 0; i--) {
101 info->protect[i] = 0; /* unprotect this sector */
102 if (start >= info->start[i])
105 /* set-up flash location */
106 /* now erase flash */
107 printf("Erasing at %lx (sector %d) (start %lx)\n",
108 start,i,info->start[i]);
109 if ((rc = flash_erase (info, i, info->sector_count-1)) != 0) {
115 #else /* #if !defined(CONFIG_PATI */
118 for (i = 0; i < info->sector_count; i++) {
119 if (start < info->start[i]) {
125 info->protect[i - 1] = 0; /* unprotect this sector */
126 for (; i < info->sector_count; i++) {
127 if ((start + size) < info->start[i])
129 info->protect[i] = 0; /* unprotect this sector */
133 /* set-up flash location */
134 /* now erase flash */
135 printf ("Erasing at %lx to %lx (sector %d to %d) (%lx to %lx)\n",
136 start, start + size, start_sect, i,
137 info->start[start_sect], info->start[i]);
138 if ((rc = flash_erase (info, start_sect, i)) != 0) {
143 #endif /* defined(CONFIG_PATI) */
145 #elif defined(CONFIG_VCMA9)
147 for (i = 0; i <info->sector_count; i++) {
148 info->protect[i] = 0; /* unprotect this sector */
149 if (size < info->start[i])
152 /* set-up flash location */
153 /* now erase flash */
154 printf("Erasing at %lx (sector %d) (start %lx)\n",
155 start,0,info->start[0]);
156 if ((rc = flash_erase (info, 0, i)) != 0) {
163 printf("flash erased, programming from 0x%lx 0x%lx Bytes\n",
165 if ((rc = flash_write ((char *)src, start, size)) != 0) {
170 puts("OK programming done\n");
176 mpl_prg_image(uchar *ld_addr)
180 image_header_t *hdr = (image_header_t *)ld_addr;
183 #if defined(CONFIG_FIT)
184 if (genimg_get_format ((void *)hdr) != IMAGE_FORMAT_LEGACY) {
185 puts ("Non legacy image format not supported\n");
190 if (!image_check_magic (hdr)) {
191 puts("Bad Magic Number\n");
194 image_print_contents (hdr);
195 if (!image_check_os (hdr, IH_OS_U_BOOT)) {
196 puts("No U-Boot Image\n");
199 if (!image_check_type (hdr, IH_TYPE_FIRMWARE)) {
200 puts("No Firmware Image\n");
203 if (!image_check_hcrc (hdr)) {
204 puts("Bad Header Checksum\n");
207 puts("Verifying Checksum ... ");
208 if (!image_check_dcrc (hdr)) {
209 puts("Bad Data CRC\n");
214 data = (uchar *)image_get_data (hdr);
215 len = image_get_data_size (hdr);
217 if (image_get_comp (hdr) != IH_COMP_NONE) {
219 /* reserve space for uncompressed image */
220 if ((buf = malloc(IMAGE_SIZE)) == NULL) {
221 puts("Insufficient space for decompression\n");
225 switch (image_get_comp (hdr)) {
227 puts("Uncompressing (GZIP) ... ");
228 rc = gunzip ((void *)(buf), IMAGE_SIZE, data, &len);
230 puts("GUNZIP ERROR\n");
238 puts("Uncompressing (BZIP2) ... ");
240 uint retlen = IMAGE_SIZE;
241 rc = BZ2_bzBuffToBuffDecompress ((char *)(buf), &retlen,
242 (char *)data, len, 0, 0);
246 printf ("BUNZIP2 ERROR: %d\n", rc);
254 printf ("Unimplemented compression type %d\n",
255 image_get_comp (hdr));
260 rc = mpl_prg(buf, len);
263 rc = mpl_prg(data, len);
269 #if !defined(CONFIG_PATI)
270 void get_backup_values(backup_t *buf)
272 i2c_read(CONFIG_SYS_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)buf,sizeof(backup_t));
275 void set_backup_values(int overwrite)
280 get_backup_values(&back);
282 if(strncmp(back.signature,"MPL\0",4)==0) {
283 puts("Not possible to write Backup\n");
287 memcpy(back.signature,"MPL\0",4);
288 i = getenv_r("serial#",back.serial_name,16);
290 puts("Not possible to write Backup\n");
293 back.serial_name[16]=0;
294 i = getenv_r("ethaddr",back.eth_addr,20);
296 puts("Not possible to write Backup\n");
300 i2c_write(CONFIG_SYS_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t));
303 void clear_env_values(void)
306 unsigned char env_crc[4];
308 memset(&back,0xff,sizeof(backup_t));
309 memset(env_crc,0x00,4);
310 i2c_write(CONFIG_SYS_DEF_EEPROM_ADDR,I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t));
311 i2c_write(CONFIG_SYS_DEF_EEPROM_ADDR,CONFIG_ENV_OFFSET,2,(void *)env_crc,4);
315 * check crc of "older" environment
317 int check_env_old_size(ulong oldsize)
324 eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR,
326 (uchar *)&crc, sizeof(ulong));
333 int n = (len > sizeof(buf)) ? sizeof(buf) : len;
335 eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, buf, n);
336 new = crc32 (new, buf, n);
344 static ulong oldsizes[] = {
350 void copy_old_env(ulong size)
353 uchar value_buf[0x800];
360 value = &value_buf[0];
364 eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, &c, 1);
373 eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, &c, 1);
380 value = &value_buf[0];
381 if(strncmp((char *)name,"baudrate",8)!=0) {
382 setenv((char *)name,(char *)value);
400 if(check_env_old_size(oldsizes[i]))
405 /* no old environment has been found */
406 get_backup_values (&back);
407 if (strncmp (back.signature, "MPL\0", 4) == 0) {
408 sprintf (buf, "%s", back.serial_name);
409 setenv ("serial#", buf);
410 sprintf (buf, "%s", back.eth_addr);
411 setenv ("ethaddr", buf);
412 printf ("INFO: serial# and ethaddr recovered, use saveenv\n");
417 copy_old_env(oldsizes[i]);
418 puts("INFO: old environment ajusted, use saveenv\n");
422 /* check if back up is set */
423 get_backup_values(&back);
424 if(strncmp(back.signature,"MPL\0",4)!=0) {
425 set_backup_values(0);
430 #endif /* #if !defined(CONFIG_PATI) */
432 int do_mplcommon(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
434 ulong size,src,ld_addr;
436 #if !defined(CONFIG_PATI)
438 src = MULTI_PURPOSE_SOCKET_ADDR;
442 if (strcmp(argv[1], "flash") == 0)
444 #if defined(CONFIG_CMD_FDC)
445 if (strcmp(argv[2], "floppy") == 0) {
447 extern int do_fdcboot (cmd_tbl_t *, int, int, char *[]);
448 puts("\nupdating bootloader image from floppy\n");
449 local_args[0] = argv[0];
451 local_args[1] = argv[3];
452 local_args[2] = NULL;
453 ld_addr=simple_strtoul(argv[3], NULL, 16);
454 result=do_fdcboot(cmdtp, 0, 2, local_args);
457 local_args[1] = NULL;
458 ld_addr=CONFIG_SYS_LOAD_ADDR;
459 result=do_fdcboot(cmdtp, 0, 1, local_args);
461 result=mpl_prg_image((uchar *)ld_addr);
465 if (strcmp(argv[2], "mem") == 0) {
467 ld_addr=simple_strtoul(argv[3], NULL, 16);
472 printf ("\nupdating bootloader image from memory at %lX\n",ld_addr);
473 result=mpl_prg_image((uchar *)ld_addr);
476 #if !defined(CONFIG_PATI)
477 if (strcmp(argv[2], "mps") == 0) {
478 puts("\nupdating bootloader image from MPS\n");
479 result=mpl_prg((uchar *)src,size);
482 #endif /* #if !defined(CONFIG_PATI) */
484 if (strcmp(argv[1], "mem") == 0)
489 result = (int)simple_strtol(argv[2], NULL, 16);
491 src=(unsigned long)&result;
492 src-=CONFIG_SYS_MEMTEST_START;
493 src-=(100*1024); /* - 100k */
498 printf("\n\nPass %ld\n",size);
499 mem_test(CONFIG_SYS_MEMTEST_START,src,1);
508 #if !defined(CONFIG_PATI)
509 if (strcmp(argv[1], "clearenvvalues") == 0)
511 if (strcmp(argv[2], "yes") == 0)
517 if (strcmp(argv[1], "getback") == 0) {
518 get_backup_values(&back);
520 back.serial_name[16]=0;
522 printf("GetBackUp: signature: %s\n",back.signature);
523 printf(" serial#: %s\n",back.serial_name);
524 printf(" ethaddr: %s\n",back.eth_addr);
527 if (strcmp(argv[1], "setback") == 0) {
528 set_backup_values(1);
537 #if defined(CONFIG_CMD_DOC)
540 doc_probe(MULTI_PURPOSE_SOCKET_ADDR);
546 /******************************************************
547 * Routines to display the Board information
548 * to the screen (since the VGA will be initialized as last,
549 * we must resend the infos)
552 #ifdef CONFIG_CONSOLE_EXTRA_INFO
553 extern GraphicDevice ctfb;
554 extern int get_boot_mode(void);
556 void video_get_info_str (int line_number, char *info)
558 /* init video info strings for graphic console */
559 PPC4xx_SYS_INFO sys_info;
564 char buf1[32], buf2[32], buf3[32], buf4[32];
570 /* CPU and board infos */
572 get_sys_info (&sys_info);
574 case PVR_405GP_RB: rev='B'; break;
575 case PVR_405GP_RC: rev='C'; break;
576 case PVR_405GP_RD: rev='D'; break;
577 case PVR_405GP_RE: rev='E'; break;
578 case PVR_405GPR_RB: rev='B'; break;
579 default: rev='?'; break;
581 if(pvr==PVR_405GPR_RB)
582 sprintf(cpustr,"PPC405GPr %c",rev);
584 sprintf(cpustr,"PPC405GP %c",rev);
587 s=getenv ("serial#");
589 if (!s || strncmp (s, "PIP405", 6)) {
590 sprintf(buf,"### No HW ID - assuming PIP405");
594 if (!s || strncmp (s, "MIP405", 6)) {
595 sprintf(buf,"### No HW ID - assuming MIP405");
599 for (e = s; *e; ++e) {
610 sprintf(&buf[i]," SN ");
617 sprintf (info," %s %s %s MHz (%s/%s/%s MHz)",
619 strmhz (buf1, gd->cpu_clk),
620 strmhz (buf2, sys_info.freqPLB),
621 strmhz (buf3, sys_info.freqPLB / sys_info.pllOpbDiv),
622 strmhz (buf4, sys_info.freqPLB / sys_info.pllExtBusDiv));
626 boot = get_boot_mode();
627 bc = in8 (CONFIG_PORT_ADDR);
628 sprintf(info, " %luMB RAM, %luMB Flash Cfg 0x%02X %s %s",
629 gd->bd->bi_memsize / 0x100000,
630 gd->bd->bi_flashsize / 0x100000,
632 (boot & BOOT_MPS) ? "MPS boot" : "Flash boot",
636 sprintf (buf, "%s",CONFIG_IDENT_STRING);
637 sprintf (info, " %s", &buf[1]);
640 /* no more info lines */
644 #endif /* CONFIG_CONSOLE_EXTRA_INFO */
646 #endif /* CONFIG_VIDEO */