]> git.sur5r.net Git - u-boot/blob - board/mpl/common/common_util.c
board/mpl: Remove mpl-specific memory test command
[u-boot] / board / mpl / common / common_util.c
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>
30 #include <asm/byteorder.h>
31 #include <i2c.h>
32 #include <pci.h>
33 #include <malloc.h>
34 #include <bzlib.h>
35
36 #ifdef CONFIG_PIP405
37 #include "../pip405/pip405.h"
38 #include <asm/4xx_pci.h>
39 #endif
40 #ifdef CONFIG_MIP405
41 #include "../mip405/mip405.h"
42 #include <asm/4xx_pci.h>
43 #endif
44
45 DECLARE_GLOBAL_DATA_PTR;
46
47 #if defined(CONFIG_PATI)
48 #define FIRM_START 0xFFF00000
49 #endif
50
51 extern int mem_test(ulong start, ulong ramsize, int quiet);
52
53 #define I2C_BACKUP_ADDR 0x7C00          /* 0x200 bytes for backup */
54 #define IMAGE_SIZE CONFIG_SYS_MONITOR_LEN       /* ugly, but it works for now */
55
56 extern flash_info_t flash_info[];       /* info for FLASH chips */
57
58 static int
59 mpl_prg(uchar *src, ulong size)
60 {
61         ulong start;
62         flash_info_t *info;
63         int i, rc;
64 #if defined(CONFIG_PATI)
65         int start_sect;
66 #endif
67 #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI)
68         char *copystr = (char *)src;
69         ulong *magic = (ulong *)src;
70 #endif
71
72         info = &flash_info[0];
73
74 #if defined(CONFIG_PIP405) || defined(CONFIG_MIP405) || defined(CONFIG_PATI)
75         if (uimage_to_cpu (magic[0]) != IH_MAGIC) {
76                 puts("Bad Magic number\n");
77                 return -1;
78         }
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          */
83         i = 4; /* skip Magic number */
84         while (1) {
85                 if (strncmp(&copystr[i], "MEV-", 4) == 0)
86                         break;
87                 if (i++ >= 0x100) {
88                         puts("Firmware Image for unknown Target\n");
89                         return -1;
90                 }
91         }
92         /* we have the ISO STRING, check */
93         if (strncmp(&copystr[i], CONFIG_ISO_STRING, sizeof(CONFIG_ISO_STRING)-1) != 0) {
94                 printf("Wrong Firmware Image: %s\n", &copystr[i]);
95                 return -1;
96         }
97 #if !defined(CONFIG_PATI)
98         start = 0 - size;
99         for (i = info->sector_count-1; i > 0; i--) {
100                 info->protect[i] = 0; /* unprotect this sector */
101                 if (start >= info->start[i])
102                         break;
103         }
104         /* set-up flash location */
105         /* now erase flash */
106         printf("Erasing at %lx (sector %d) (start %lx)\n",
107                                 start,i,info->start[i]);
108         if ((rc = flash_erase (info, i, info->sector_count-1)) != 0) {
109                 puts("ERROR ");
110                 flash_perror(rc);
111                 return (1);
112         }
113
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
144 #elif defined(CONFIG_VCMA9)
145         start = 0;
146         for (i = 0; i <info->sector_count; i++) {
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]);
155         if ((rc = flash_erase (info, 0, i)) != 0) {
156                 puts("ERROR ");
157                 flash_perror(rc);
158                 return (1);
159         }
160
161 #endif
162         printf("flash erased, programming from 0x%lx 0x%lx Bytes\n",
163                 (ulong)src, size);
164         if ((rc = flash_write ((char *)src, start, size)) != 0) {
165                 puts("ERROR ");
166                 flash_perror(rc);
167                 return (1);
168         }
169         puts("OK programming done\n");
170         return 0;
171 }
172
173
174 static int
175 mpl_prg_image(uchar *ld_addr)
176 {
177         unsigned long len;
178         uchar *data;
179         image_header_t *hdr = (image_header_t *)ld_addr;
180         int rc;
181
182 #if defined(CONFIG_FIT)
183         if (genimg_get_format ((void *)hdr) != IMAGE_FORMAT_LEGACY) {
184                 puts ("Non legacy image format not supported\n");
185                 return -1;
186         }
187 #endif
188
189         if (!image_check_magic (hdr)) {
190                 puts("Bad Magic Number\n");
191                 return 1;
192         }
193         image_print_contents (hdr);
194         if (!image_check_os (hdr, IH_OS_U_BOOT)) {
195                 puts("No U-Boot Image\n");
196                 return 1;
197         }
198         if (!image_check_type (hdr, IH_TYPE_FIRMWARE)) {
199                 puts("No Firmware Image\n");
200                 return 1;
201         }
202         if (!image_check_hcrc (hdr)) {
203                 puts("Bad Header Checksum\n");
204                 return 1;
205         }
206         puts("Verifying Checksum ... ");
207         if (!image_check_dcrc (hdr)) {
208                 puts("Bad Data CRC\n");
209                 return 1;
210         }
211         puts("OK\n");
212
213         data = (uchar *)image_get_data (hdr);
214         len = image_get_data_size (hdr);
215
216         if (image_get_comp (hdr) != IH_COMP_NONE) {
217                 uchar *buf;
218                 /* reserve space for uncompressed image */
219                 if ((buf = malloc(IMAGE_SIZE)) == NULL) {
220                         puts("Insufficient space for decompression\n");
221                         return 1;
222                 }
223
224                 switch (image_get_comp (hdr)) {
225                 case IH_COMP_GZIP:
226                         puts("Uncompressing (GZIP) ... ");
227                         rc = gunzip ((void *)(buf), IMAGE_SIZE, data, &len);
228                         if (rc != 0) {
229                                 puts("GUNZIP ERROR\n");
230                                 free(buf);
231                                 return 1;
232                         }
233                         puts("OK\n");
234                         break;
235 #ifdef CONFIG_BZIP2
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:
253                         printf ("Unimplemented compression type %d\n",
254                                 image_get_comp (hdr));
255                         free(buf);
256                         return 1;
257                 }
258
259                 rc = mpl_prg(buf, len);
260                 free(buf);
261         } else {
262                 rc = mpl_prg(data, len);
263         }
264
265         return(rc);
266 }
267
268 #if !defined(CONFIG_PATI)
269 void get_backup_values(backup_t *buf)
270 {
271         i2c_read(CONFIG_SYS_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)buf,sizeof(backup_t));
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) {
282                         puts("Not possible to write Backup\n");
283                         return;
284                 }
285         }
286         memcpy(back.signature,"MPL\0",4);
287         i = getenv_f("serial#",back.serial_name,16);
288         if(i < 0) {
289                 puts("Not possible to write Backup\n");
290                 return;
291         }
292         back.serial_name[16]=0;
293         i = getenv_f("ethaddr",back.eth_addr,20);
294         if(i < 0) {
295                 puts("Not possible to write Backup\n");
296                 return;
297         }
298         back.eth_addr[20]=0;
299         i2c_write(CONFIG_SYS_DEF_EEPROM_ADDR, I2C_BACKUP_ADDR,2,(void *)&back,sizeof(backup_t));
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);
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);
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 */
323         eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR,
324                      CONFIG_ENV_OFFSET,
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
334                 eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, buf, n);
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
358         name = &name_buf[0];
359         value = &value_buf[0];
360         len=size;
361         off = sizeof(long);
362         while (len > off) {
363                 eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, &c, 1);
364                 if(c != '=') {
365                         *name++=c;
366                         off++;
367                 }
368                 else {
369                         *name++='\0';
370                         off++;
371                         do {
372                                 eeprom_read (CONFIG_SYS_DEF_EEPROM_ADDR, CONFIG_ENV_OFFSET+off, &c, 1);
373                                 *value++=c;
374                                 off++;
375                                 if(c == '\0')
376                                         break;
377                         } while(len > off);
378                         name = &name_buf[0];
379                         value = &value_buf[0];
380                         if(strncmp((char *)name,"baudrate",8)!=0) {
381                                 setenv((char *)name,(char *)value);
382                         }
383
384                 }
385         }
386 }
387
388
389 void check_env(void)
390 {
391         char *s;
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]);
417                         puts("INFO:  old environment ajusted, use saveenv\n");
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
429 #endif /* #if !defined(CONFIG_PATI) */
430
431 int do_mplcommon(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
432 {
433         ulong ld_addr;
434         int result;
435 #if !defined(CONFIG_PATI)
436         ulong size = IMAGE_SIZE;
437         ulong src = MULTI_PURPOSE_SOCKET_ADDR;
438         backup_t back;
439 #endif
440
441         if (strcmp(argv[1], "flash") == 0)
442         {
443 #if defined(CONFIG_CMD_FDC)
444                 if (strcmp(argv[2], "floppy") == 0) {
445                         char *local_args[3];
446                         extern int do_fdcboot (cmd_tbl_t *, int, int, char *[]);
447                         puts("\nupdating bootloader image from floppy\n");
448                         local_args[0] = argv[0];
449                         if(argc==4) {
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;
457                                 ld_addr=CONFIG_SYS_LOAD_ADDR;
458                                 result=do_fdcboot(cmdtp, 0, 1, local_args);
459                         }
460                         result=mpl_prg_image((uchar *)ld_addr);
461                         return result;
462                 }
463 #endif
464                 if (strcmp(argv[2], "mem") == 0) {
465                         if(argc==4) {
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);
472                         result=mpl_prg_image((uchar *)ld_addr);
473                         return result;
474                 }
475 #if !defined(CONFIG_PATI)
476                 if (strcmp(argv[2], "mps") == 0) {
477                         puts("\nupdating bootloader image from MPS\n");
478                         result=mpl_prg((uchar *)src,size);
479                         return result;
480                 }
481 #endif /* #if !defined(CONFIG_PATI)     */
482         }
483 #if !defined(CONFIG_PATI)
484         if (strcmp(argv[1], "clearenvvalues") == 0)
485         {
486                 if (strcmp(argv[2], "yes") == 0)
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         }
506 #endif
507         return cmd_usage(cmdtp);
508 }
509
510
511 #if defined(CONFIG_CMD_DOC)
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;
528 extern int get_boot_mode(void);
529
530 void video_get_info_str (int line_number, char *info)
531 {
532         /* init video info strings for graphic console */
533         PPC4xx_SYS_INFO sys_info;
534         char rev;
535         int i,boot;
536         unsigned long pvr;
537         char buf[64];
538         char buf1[32], buf2[32], buf3[32], buf4[32];
539         char cpustr[16];
540         char *s, *e, bc;
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;
552                         case PVR_405GPR_RB: rev='B'; break;
553                         default:           rev='?'; break;
554                 }
555                 if(pvr==PVR_405GPR_RB)
556                         sprintf(cpustr,"PPC405GPr %c",rev);
557                 else
558                         sprintf(cpustr,"PPC405GP %c",rev);
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                                 }
582                                 buf[i++] = *s;
583                         }
584                         sprintf(&buf[i]," SN ");
585                         i+=4;
586                         for (; s < e; ++s) {
587                                 buf[i++] = *s;
588                         }
589                         buf[i++]=0;
590                 }
591                 sprintf (info," %s %s %s MHz (%s/%s/%s MHz)",
592                         buf, cpustr,
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));
597                 return;
598         case 3:
599                 /* Memory Info */
600                 boot = get_boot_mode();
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,
606                         (boot & BOOT_MPS) ? "MPS boot" : "Flash boot",
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 */