wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 1 | /* |
| 2 | * (C) Copyright 2001 |
| 3 | * Denis Peter, MPL AG Switzerland, d.peter@mpl.ch |
| 4 | * |
| 5 | * See file CREDITS for list of people who contributed to this |
| 6 | * project. |
| 7 | * |
| 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. |
| 12 | * |
| 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. |
| 17 | * |
| 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, |
| 21 | * MA 02111-1307 USA |
| 22 | * |
| 23 | */ |
| 24 | |
| 25 | #include <common.h> |
| 26 | #include <command.h> |
| 27 | #include <video_fb.h> |
| 28 | #include "common_util.h" |
| 29 | #include <asm/processor.h> |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 30 | #include <asm/byteorder.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 31 | #include <i2c.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 32 | #include <pci.h> |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 33 | #include <malloc.h> |
| 34 | #include <bzlib.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 35 | |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 36 | #ifdef CONFIG_PIP405 |
| 37 | #include "../pip405/pip405.h" |
Stefan Roese | ca8725f | 2007-10-03 15:01:02 +0200 | [diff] [blame] | 38 | #include <asm/4xx_pci.h> |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 39 | #endif |
| 40 | #ifdef CONFIG_MIP405 |
| 41 | #include "../mip405/mip405.h" |
Stefan Roese | ca8725f | 2007-10-03 15:01:02 +0200 | [diff] [blame] | 42 | #include <asm/4xx_pci.h> |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 43 | #endif |
Wolfgang Denk | 6405a15 | 2006-03-31 18:32:53 +0200 | [diff] [blame] | 44 | |
| 45 | DECLARE_GLOBAL_DATA_PTR; |
| 46 | |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 47 | #if defined(CONFIG_PATI) |
| 48 | #define FIRM_START 0xFFF00000 |
| 49 | #endif |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 50 | |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 51 | extern int mem_test(ulong start, ulong ramsize, int quiet); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 52 | |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 53 | #define I2C_BACKUP_ADDR 0x7C00 /* 0x200 bytes for backup */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 54 | #define IMAGE_SIZE CONFIG_SYS_MONITOR_LEN /* ugly, but it works for now */ |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 55 | |
| 56 | extern flash_info_t flash_info[]; /* info for FLASH chips */ |
| 57 | |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 58 | static int |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 59 | mpl_prg(uchar *src, ulong size) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 60 | { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 61 | ulong start; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 62 | flash_info_t *info; |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 63 | int i, rc; |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 64 | #if defined(CONFIG_PATI) |
| 65 | int start_sect; |
| 66 | #endif |
| 67 | #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI) |
wdenk | e39c284 | 2003-06-04 15:05:30 +0000 | [diff] [blame] | 68 | char *copystr = (char *)src; |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 69 | ulong *magic = (ulong *)src; |
wdenk | 6b58f33 | 2003-03-14 20:47:52 +0000 | [diff] [blame] | 70 | #endif |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 71 | |
| 72 | info = &flash_info[0]; |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 73 | |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 74 | #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI) |
Marian Balakowicz | d7c88a4 | 2008-02-29 14:58:34 +0100 | [diff] [blame] | 75 | if (uimage_to_cpu (magic[0]) != IH_MAGIC) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 76 | puts("Bad Magic number\n"); |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 77 | return -1; |
| 78 | } |
wdenk | e39c284 | 2003-06-04 15:05:30 +0000 | [diff] [blame] | 79 | /* some more checks before we delete the Flash... */ |
| 80 | /* Checking the ISO_STRING prevents to program a |
| 81 | * wrong Firmware Image into the flash. |
| 82 | */ |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 83 | i = 4; /* skip Magic number */ |
| 84 | while (1) { |
| 85 | if (strncmp(©str[i], "MEV-", 4) == 0) |
wdenk | e39c284 | 2003-06-04 15:05:30 +0000 | [diff] [blame] | 86 | break; |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 87 | if (i++ >= 0x100) { |
| 88 | puts("Firmware Image for unknown Target\n"); |
wdenk | e39c284 | 2003-06-04 15:05:30 +0000 | [diff] [blame] | 89 | return -1; |
| 90 | } |
| 91 | } |
| 92 | /* we have the ISO STRING, check */ |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 93 | if (strncmp(©str[i], CONFIG_ISO_STRING, sizeof(CONFIG_ISO_STRING)-1) != 0) { |
| 94 | printf("Wrong Firmware Image: %s\n", ©str[i]); |
wdenk | e39c284 | 2003-06-04 15:05:30 +0000 | [diff] [blame] | 95 | return -1; |
| 96 | } |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 97 | #if !defined(CONFIG_PATI) |
wdenk | e39c284 | 2003-06-04 15:05:30 +0000 | [diff] [blame] | 98 | start = 0 - size; |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 99 | for (i = info->sector_count-1; i > 0; i--) { |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 100 | info->protect[i] = 0; /* unprotect this sector */ |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 101 | if (start >= info->start[i]) |
| 102 | break; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 103 | } |
| 104 | /* set-up flash location */ |
| 105 | /* now erase flash */ |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 106 | printf("Erasing at %lx (sector %d) (start %lx)\n", |
| 107 | start,i,info->start[i]); |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 108 | if ((rc = flash_erase (info, i, info->sector_count-1)) != 0) { |
| 109 | puts("ERROR "); |
| 110 | flash_perror(rc); |
| 111 | return (1); |
| 112 | } |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 113 | |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 114 | #else /* #if !defined(CONFIG_PATI */ |
| 115 | start = FIRM_START; |
| 116 | start_sect = -1; |
| 117 | for (i = 0; i < info->sector_count; i++) { |
| 118 | if (start < info->start[i]) { |
| 119 | start_sect = i - 1; |
| 120 | break; |
| 121 | } |
| 122 | } |
| 123 | |
| 124 | info->protect[i - 1] = 0; /* unprotect this sector */ |
| 125 | for (; i < info->sector_count; i++) { |
| 126 | if ((start + size) < info->start[i]) |
| 127 | break; |
| 128 | info->protect[i] = 0; /* unprotect this sector */ |
| 129 | } |
| 130 | |
| 131 | i--; |
| 132 | /* set-up flash location */ |
| 133 | /* now erase flash */ |
| 134 | printf ("Erasing at %lx to %lx (sector %d to %d) (%lx to %lx)\n", |
| 135 | start, start + size, start_sect, i, |
| 136 | info->start[start_sect], info->start[i]); |
| 137 | if ((rc = flash_erase (info, start_sect, i)) != 0) { |
| 138 | puts ("ERROR "); |
| 139 | flash_perror (rc); |
| 140 | return (1); |
| 141 | } |
| 142 | #endif /* defined(CONFIG_PATI) */ |
| 143 | |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 144 | #elif defined(CONFIG_VCMA9) |
| 145 | start = 0; |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 146 | for (i = 0; i <info->sector_count; i++) { |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 147 | info->protect[i] = 0; /* unprotect this sector */ |
| 148 | if (size < info->start[i]) |
| 149 | break; |
| 150 | } |
| 151 | /* set-up flash location */ |
| 152 | /* now erase flash */ |
| 153 | printf("Erasing at %lx (sector %d) (start %lx)\n", |
| 154 | start,0,info->start[0]); |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 155 | if ((rc = flash_erase (info, 0, i)) != 0) { |
| 156 | puts("ERROR "); |
| 157 | flash_perror(rc); |
| 158 | return (1); |
| 159 | } |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 160 | |
| 161 | #endif |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 162 | printf("flash erased, programming from 0x%lx 0x%lx Bytes\n", |
| 163 | (ulong)src, size); |
Wolfgang Denk | 7fb5266 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 164 | if ((rc = flash_write ((char *)src, start, size)) != 0) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 165 | puts("ERROR "); |
| 166 | flash_perror(rc); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 167 | return (1); |
| 168 | } |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 169 | puts("OK programming done\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 170 | return 0; |
| 171 | } |
| 172 | |
| 173 | |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 174 | static int |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 175 | mpl_prg_image(uchar *ld_addr) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 176 | { |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 177 | unsigned long len; |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 178 | uchar *data; |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 179 | image_header_t *hdr = (image_header_t *)ld_addr; |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 180 | int rc; |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 181 | |
Marian Balakowicz | dbdd16a | 2008-02-04 08:28:09 +0100 | [diff] [blame] | 182 | #if defined(CONFIG_FIT) |
Marian Balakowicz | d7c88a4 | 2008-02-29 14:58:34 +0100 | [diff] [blame] | 183 | if (genimg_get_format ((void *)hdr) != IMAGE_FORMAT_LEGACY) { |
Marian Balakowicz | dbdd16a | 2008-02-04 08:28:09 +0100 | [diff] [blame] | 184 | puts ("Non legacy image format not supported\n"); |
| 185 | return -1; |
| 186 | } |
| 187 | #endif |
| 188 | |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 189 | if (!image_check_magic (hdr)) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 190 | puts("Bad Magic Number\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 191 | return 1; |
| 192 | } |
Marian Balakowicz | a1cc147 | 2008-02-21 17:27:41 +0100 | [diff] [blame] | 193 | image_print_contents (hdr); |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 194 | if (!image_check_os (hdr, IH_OS_U_BOOT)) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 195 | puts("No U-Boot Image\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 196 | return 1; |
| 197 | } |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 198 | if (!image_check_type (hdr, IH_TYPE_FIRMWARE)) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 199 | puts("No Firmware Image\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 200 | return 1; |
| 201 | } |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 202 | if (!image_check_hcrc (hdr)) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 203 | puts("Bad Header Checksum\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 204 | return 1; |
| 205 | } |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 206 | puts("Verifying Checksum ... "); |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 207 | if (!image_check_dcrc (hdr)) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 208 | puts("Bad Data CRC\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 209 | return 1; |
| 210 | } |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 211 | puts("OK\n"); |
| 212 | |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 213 | data = (uchar *)image_get_data (hdr); |
| 214 | len = image_get_data_size (hdr); |
| 215 | |
| 216 | if (image_get_comp (hdr) != IH_COMP_NONE) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 217 | uchar *buf; |
| 218 | /* reserve space for uncompressed image */ |
| 219 | if ((buf = malloc(IMAGE_SIZE)) == NULL) { |
Wolfgang Denk | a1be476 | 2008-05-20 16:00:29 +0200 | [diff] [blame] | 220 | puts("Insufficient space for decompression\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 221 | return 1; |
| 222 | } |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 223 | |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 224 | switch (image_get_comp (hdr)) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 225 | case IH_COMP_GZIP: |
| 226 | puts("Uncompressing (GZIP) ... "); |
wdenk | a0ebde5 | 2004-09-08 22:03:11 +0000 | [diff] [blame] | 227 | rc = gunzip ((void *)(buf), IMAGE_SIZE, data, &len); |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 228 | if (rc != 0) { |
| 229 | puts("GUNZIP ERROR\n"); |
| 230 | free(buf); |
| 231 | return 1; |
| 232 | } |
| 233 | puts("OK\n"); |
| 234 | break; |
wdenk | c35ba4e | 2004-03-14 22:25:36 +0000 | [diff] [blame] | 235 | #ifdef CONFIG_BZIP2 |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 236 | case IH_COMP_BZIP2: |
| 237 | puts("Uncompressing (BZIP2) ... "); |
| 238 | { |
| 239 | uint retlen = IMAGE_SIZE; |
| 240 | rc = BZ2_bzBuffToBuffDecompress ((char *)(buf), &retlen, |
| 241 | (char *)data, len, 0, 0); |
| 242 | len = retlen; |
| 243 | } |
| 244 | if (rc != BZ_OK) { |
| 245 | printf ("BUNZIP2 ERROR: %d\n", rc); |
| 246 | free(buf); |
| 247 | return 1; |
| 248 | } |
| 249 | puts("OK\n"); |
| 250 | break; |
| 251 | #endif |
| 252 | default: |
Marian Balakowicz | 41d71ed | 2008-01-08 18:14:09 +0100 | [diff] [blame] | 253 | printf ("Unimplemented compression type %d\n", |
| 254 | image_get_comp (hdr)); |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 255 | free(buf); |
| 256 | return 1; |
| 257 | } |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 258 | |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 259 | rc = mpl_prg(buf, len); |
| 260 | free(buf); |
| 261 | } else { |
| 262 | rc = mpl_prg(data, len); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 263 | } |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 264 | |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 265 | return(rc); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 266 | } |
| 267 | |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 268 | #if !defined(CONFIG_PATI) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 269 | void get_backup_values(backup_t *buf) |
| 270 | { |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 271 | i2c_read(CONFIG_SYS_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)buf,sizeof(backup_t)); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 272 | } |
| 273 | |
| 274 | void set_backup_values(int overwrite) |
| 275 | { |
| 276 | backup_t back; |
| 277 | int i; |
| 278 | |
| 279 | get_backup_values(&back); |
| 280 | if(!overwrite) { |
| 281 | if(strncmp(back.signature,"MPL\0",4)==0) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 282 | puts("Not possible to write Backup\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 283 | return; |
| 284 | } |
| 285 | } |
| 286 | memcpy(back.signature,"MPL\0",4); |
Wolfgang Denk | 76af278 | 2010-07-24 21:55:43 +0200 | [diff] [blame] | 287 | i = getenv_f("serial#",back.serial_name,16); |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 288 | if(i < 0) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 289 | puts("Not possible to write Backup\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 290 | return; |
| 291 | } |
| 292 | back.serial_name[16]=0; |
Wolfgang Denk | 76af278 | 2010-07-24 21:55:43 +0200 | [diff] [blame] | 293 | i = getenv_f("ethaddr",back.eth_addr,20); |
wdenk | 1fe2c70 | 2003-03-06 21:55:29 +0000 | [diff] [blame] | 294 | if(i < 0) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 295 | puts("Not possible to write Backup\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 296 | return; |
| 297 | } |
| 298 | back.eth_addr[20]=0; |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 299 | i2c_write(CONFIG_SYS_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t)); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 300 | } |
| 301 | |
| 302 | void clear_env_values(void) |
| 303 | { |
| 304 | backup_t back; |
| 305 | unsigned char env_crc[4]; |
| 306 | |
| 307 | memset(&back,0xff,sizeof(backup_t)); |
| 308 | memset(env_crc,0x00,4); |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 309 | i2c_write(CONFIG_SYS_DEF_EEPROM_ADDR,I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t)); |
| 310 | i2c_write(CONFIG_SYS_DEF_EEPROM_ADDR,CONFIG_ENV_OFFSET,2,(void *)env_crc,4); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 311 | } |
| 312 | |
| 313 | /* |
| 314 | * check crc of "older" environment |
| 315 | */ |
| 316 | int check_env_old_size(ulong oldsize) |
| 317 | { |
| 318 | ulong crc, len, new; |
| 319 | unsigned off; |
| 320 | uchar buf[64]; |
| 321 | |
| 322 | /* read old CRC */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 323 | eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, |
Jean-Christophe PLAGNIOL-VILLARD | 7e1cda6 | 2008-09-10 22:48:06 +0200 | [diff] [blame] | 324 | CONFIG_ENV_OFFSET, |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 325 | (uchar *)&crc, sizeof(ulong)); |
| 326 | |
| 327 | new = 0; |
| 328 | len = oldsize; |
| 329 | off = sizeof(long); |
| 330 | len = oldsize-off; |
| 331 | while (len > 0) { |
| 332 | int n = (len > sizeof(buf)) ? sizeof(buf) : len; |
| 333 | |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 334 | eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, buf, n); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 335 | new = crc32 (new, buf, n); |
| 336 | len -= n; |
| 337 | off += n; |
| 338 | } |
| 339 | |
| 340 | return (crc == new); |
| 341 | } |
| 342 | |
| 343 | static ulong oldsizes[] = { |
| 344 | 0x200, |
| 345 | 0x800, |
| 346 | 0 |
| 347 | }; |
| 348 | |
| 349 | void copy_old_env(ulong size) |
| 350 | { |
| 351 | uchar name_buf[64]; |
| 352 | uchar value_buf[0x800]; |
| 353 | uchar c; |
| 354 | ulong len; |
| 355 | unsigned off; |
| 356 | uchar *name, *value; |
| 357 | |
Wolfgang Denk | dc770c7 | 2008-07-14 15:19:07 +0200 | [diff] [blame] | 358 | name = &name_buf[0]; |
| 359 | value = &value_buf[0]; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 360 | len=size; |
| 361 | off = sizeof(long); |
| 362 | while (len > off) { |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 363 | eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, &c, 1); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 364 | if(c != '=') { |
| 365 | *name++=c; |
| 366 | off++; |
| 367 | } |
| 368 | else { |
| 369 | *name++='\0'; |
| 370 | off++; |
| 371 | do { |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 372 | eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, &c, 1); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 373 | *value++=c; |
| 374 | off++; |
| 375 | if(c == '\0') |
| 376 | break; |
| 377 | } while(len > off); |
Wolfgang Denk | dc770c7 | 2008-07-14 15:19:07 +0200 | [diff] [blame] | 378 | name = &name_buf[0]; |
| 379 | value = &value_buf[0]; |
Wolfgang Denk | 7fb5266 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 380 | if(strncmp((char *)name,"baudrate",8)!=0) { |
| 381 | setenv((char *)name,(char *)value); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 382 | } |
| 383 | |
| 384 | } |
| 385 | } |
| 386 | } |
| 387 | |
| 388 | |
| 389 | void check_env(void) |
| 390 | { |
Wolfgang Denk | 7fb5266 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 391 | char *s; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 392 | int i=0; |
| 393 | char buf[32]; |
| 394 | backup_t back; |
| 395 | |
| 396 | s=getenv("serial#"); |
| 397 | if(!s) { |
| 398 | while(oldsizes[i]) { |
| 399 | if(check_env_old_size(oldsizes[i])) |
| 400 | break; |
| 401 | i++; |
| 402 | } |
| 403 | if(!oldsizes[i]) { |
| 404 | /* no old environment has been found */ |
| 405 | get_backup_values (&back); |
| 406 | if (strncmp (back.signature, "MPL\0", 4) == 0) { |
| 407 | sprintf (buf, "%s", back.serial_name); |
| 408 | setenv ("serial#", buf); |
| 409 | sprintf (buf, "%s", back.eth_addr); |
| 410 | setenv ("ethaddr", buf); |
| 411 | printf ("INFO: serial# and ethaddr recovered, use saveenv\n"); |
| 412 | return; |
| 413 | } |
| 414 | } |
| 415 | else { |
| 416 | copy_old_env(oldsizes[i]); |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 417 | puts("INFO: old environment ajusted, use saveenv\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 418 | } |
| 419 | } |
| 420 | else { |
| 421 | /* check if back up is set */ |
| 422 | get_backup_values(&back); |
| 423 | if(strncmp(back.signature,"MPL\0",4)!=0) { |
| 424 | set_backup_values(0); |
| 425 | } |
| 426 | } |
| 427 | } |
| 428 | |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 429 | #endif /* #if !defined(CONFIG_PATI) */ |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 430 | |
Wolfgang Denk | 6262d021 | 2010-06-28 22:00:46 +0200 | [diff] [blame] | 431 | int do_mplcommon(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 432 | { |
Peter Tyser | e9b1b49 | 2010-10-05 23:48:47 -0500 | [diff] [blame] | 433 | ulong ld_addr; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 434 | int result; |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 435 | #if !defined(CONFIG_PATI) |
Peter Tyser | e9b1b49 | 2010-10-05 23:48:47 -0500 | [diff] [blame] | 436 | ulong size = IMAGE_SIZE; |
| 437 | ulong src = MULTI_PURPOSE_SOCKET_ADDR; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 438 | backup_t back; |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 439 | #endif |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 440 | |
| 441 | if (strcmp(argv[1], "flash") == 0) |
| 442 | { |
Jon Loeliger | 145318c | 2007-07-09 18:38:39 -0500 | [diff] [blame] | 443 | #if defined(CONFIG_CMD_FDC) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 444 | if (strcmp(argv[2], "floppy") == 0) { |
Wolfgang Denk | a1be476 | 2008-05-20 16:00:29 +0200 | [diff] [blame] | 445 | char *local_args[3]; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 446 | extern int do_fdcboot (cmd_tbl_t *, int, int, char *[]); |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 447 | puts("\nupdating bootloader image from floppy\n"); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 448 | local_args[0] = argv[0]; |
Wolfgang Denk | a1be476 | 2008-05-20 16:00:29 +0200 | [diff] [blame] | 449 | if(argc==4) { |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 450 | local_args[1] = argv[3]; |
| 451 | local_args[2] = NULL; |
| 452 | ld_addr=simple_strtoul(argv[3], NULL, 16); |
| 453 | result=do_fdcboot(cmdtp, 0, 2, local_args); |
| 454 | } |
| 455 | else { |
| 456 | local_args[1] = NULL; |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 457 | ld_addr=CONFIG_SYS_LOAD_ADDR; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 458 | result=do_fdcboot(cmdtp, 0, 1, local_args); |
| 459 | } |
wdenk | 1ebf41e | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 460 | result=mpl_prg_image((uchar *)ld_addr); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 461 | return result; |
| 462 | } |
Jon Loeliger | 145318c | 2007-07-09 18:38:39 -0500 | [diff] [blame] | 463 | #endif |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 464 | if (strcmp(argv[2], "mem") == 0) { |
Wolfgang Denk | a1be476 | 2008-05-20 16:00:29 +0200 | [diff] [blame] | 465 | if(argc==4) { |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 466 | ld_addr=simple_strtoul(argv[3], NULL, 16); |
| 467 | } |
| 468 | else { |
| 469 | ld_addr=load_addr; |
| 470 | } |
| 471 | printf ("\nupdating bootloader image from memory at %lX\n",ld_addr); |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 472 | result=mpl_prg_image((uchar *)ld_addr); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 473 | return result; |
| 474 | } |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 475 | #if !defined(CONFIG_PATI) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 476 | if (strcmp(argv[2], "mps") == 0) { |
wdenk | 4ea537d | 2003-12-07 18:32:37 +0000 | [diff] [blame] | 477 | puts("\nupdating bootloader image from MPS\n"); |
| 478 | result=mpl_prg((uchar *)src,size); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 479 | return result; |
| 480 | } |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 481 | #endif /* #if !defined(CONFIG_PATI) */ |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 482 | } |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 483 | #if !defined(CONFIG_PATI) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 484 | if (strcmp(argv[1], "clearenvvalues") == 0) |
| 485 | { |
Wolfgang Denk | a1be476 | 2008-05-20 16:00:29 +0200 | [diff] [blame] | 486 | if (strcmp(argv[2], "yes") == 0) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 487 | { |
| 488 | clear_env_values(); |
| 489 | return 0; |
| 490 | } |
| 491 | } |
| 492 | if (strcmp(argv[1], "getback") == 0) { |
| 493 | get_backup_values(&back); |
| 494 | back.signature[3]=0; |
| 495 | back.serial_name[16]=0; |
| 496 | back.eth_addr[20]=0; |
| 497 | printf("GetBackUp: signature: %s\n",back.signature); |
| 498 | printf(" serial#: %s\n",back.serial_name); |
| 499 | printf(" ethaddr: %s\n",back.eth_addr); |
| 500 | return 0; |
| 501 | } |
| 502 | if (strcmp(argv[1], "setback") == 0) { |
| 503 | set_backup_values(1); |
| 504 | return 0; |
| 505 | } |
wdenk | bc01dd5 | 2004-01-02 16:05:07 +0000 | [diff] [blame] | 506 | #endif |
Wolfgang Denk | 3b68311 | 2010-07-17 01:06:04 +0200 | [diff] [blame] | 507 | return cmd_usage(cmdtp); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 508 | } |
| 509 | |
| 510 | |
Jon Loeliger | 145318c | 2007-07-09 18:38:39 -0500 | [diff] [blame] | 511 | #if defined(CONFIG_CMD_DOC) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 512 | void doc_init (void) |
| 513 | { |
| 514 | doc_probe(MULTI_PURPOSE_SOCKET_ADDR); |
| 515 | } |
| 516 | #endif |
| 517 | |
| 518 | |
| 519 | #ifdef CONFIG_VIDEO |
| 520 | /****************************************************** |
| 521 | * Routines to display the Board information |
| 522 | * to the screen (since the VGA will be initialized as last, |
| 523 | * we must resend the infos) |
| 524 | */ |
| 525 | |
| 526 | #ifdef CONFIG_CONSOLE_EXTRA_INFO |
| 527 | extern GraphicDevice ctfb; |
wdenk | 2c9b05d | 2003-09-10 22:30:53 +0000 | [diff] [blame] | 528 | extern int get_boot_mode(void); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 529 | |
| 530 | void video_get_info_str (int line_number, char *info) |
| 531 | { |
| 532 | /* init video info strings for graphic console */ |
Stefan Roese | edd73f2 | 2007-10-21 08:12:41 +0200 | [diff] [blame] | 533 | PPC4xx_SYS_INFO sys_info; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 534 | char rev; |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 535 | int i,boot; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 536 | unsigned long pvr; |
| 537 | char buf[64]; |
Wolfgang Denk | 2059104 | 2008-10-19 02:35:49 +0200 | [diff] [blame] | 538 | char buf1[32], buf2[32], buf3[32], buf4[32]; |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 539 | char cpustr[16]; |
Wolfgang Denk | 7fb5266 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 540 | char *s, *e, bc; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 541 | switch (line_number) |
| 542 | { |
| 543 | case 2: |
| 544 | /* CPU and board infos */ |
| 545 | pvr=get_pvr(); |
| 546 | get_sys_info (&sys_info); |
| 547 | switch (pvr) { |
| 548 | case PVR_405GP_RB: rev='B'; break; |
| 549 | case PVR_405GP_RC: rev='C'; break; |
| 550 | case PVR_405GP_RD: rev='D'; break; |
| 551 | case PVR_405GP_RE: rev='E'; break; |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 552 | case PVR_405GPR_RB: rev='B'; break; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 553 | default: rev='?'; break; |
| 554 | } |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 555 | if(pvr==PVR_405GPR_RB) |
| 556 | sprintf(cpustr,"PPC405GPr %c",rev); |
| 557 | else |
| 558 | sprintf(cpustr,"PPC405GP %c",rev); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 559 | /* Board info */ |
| 560 | i=0; |
| 561 | s=getenv ("serial#"); |
| 562 | #ifdef CONFIG_PIP405 |
| 563 | if (!s || strncmp (s, "PIP405", 6)) { |
| 564 | sprintf(buf,"### No HW ID - assuming PIP405"); |
| 565 | } |
| 566 | #endif |
| 567 | #ifdef CONFIG_MIP405 |
| 568 | if (!s || strncmp (s, "MIP405", 6)) { |
| 569 | sprintf(buf,"### No HW ID - assuming MIP405"); |
| 570 | } |
| 571 | #endif |
| 572 | else { |
| 573 | for (e = s; *e; ++e) { |
| 574 | if (*e == ' ') |
| 575 | break; |
| 576 | } |
| 577 | for (; s < e; ++s) { |
| 578 | if (*s == '_') { |
| 579 | ++s; |
| 580 | break; |
| 581 | } |
Wolfgang Denk | dc770c7 | 2008-07-14 15:19:07 +0200 | [diff] [blame] | 582 | buf[i++] = *s; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 583 | } |
| 584 | sprintf(&buf[i]," SN "); |
| 585 | i+=4; |
| 586 | for (; s < e; ++s) { |
Wolfgang Denk | dc770c7 | 2008-07-14 15:19:07 +0200 | [diff] [blame] | 587 | buf[i++] = *s; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 588 | } |
| 589 | buf[i++]=0; |
| 590 | } |
Wolfgang Denk | 2059104 | 2008-10-19 02:35:49 +0200 | [diff] [blame] | 591 | sprintf (info," %s %s %s MHz (%s/%s/%s MHz)", |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 592 | buf, cpustr, |
Wolfgang Denk | 2059104 | 2008-10-19 02:35:49 +0200 | [diff] [blame] | 593 | strmhz (buf1, gd->cpu_clk), |
| 594 | strmhz (buf2, sys_info.freqPLB), |
| 595 | strmhz (buf3, sys_info.freqPLB / sys_info.pllOpbDiv), |
| 596 | strmhz (buf4, sys_info.freqPLB / sys_info.pllExtBusDiv)); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 597 | return; |
| 598 | case 3: |
| 599 | /* Memory Info */ |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 600 | boot = get_boot_mode(); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 601 | bc = in8 (CONFIG_PORT_ADDR); |
| 602 | sprintf(info, " %luMB RAM, %luMB Flash Cfg 0x%02X %s %s", |
| 603 | gd->bd->bi_memsize / 0x100000, |
| 604 | gd->bd->bi_flashsize / 0x100000, |
| 605 | bc, |
wdenk | 7d07641 | 2003-05-23 11:38:58 +0000 | [diff] [blame] | 606 | (boot & BOOT_MPS) ? "MPS boot" : "Flash boot", |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 607 | ctfb.modeIdent); |
| 608 | return; |
| 609 | case 1: |
| 610 | sprintf (buf, "%s",CONFIG_IDENT_STRING); |
| 611 | sprintf (info, " %s", &buf[1]); |
| 612 | return; |
| 613 | } |
| 614 | /* no more info lines */ |
| 615 | *info = 0; |
| 616 | return; |
| 617 | } |
| 618 | #endif /* CONFIG_CONSOLE_EXTRA_INFO */ |
| 619 | |
| 620 | #endif /* CONFIG_VIDEO */ |