arch/ppc/coffboot/main.c

   1 /*
   2  * Copyright (C) Paul Mackerras 1997.
   3  *
   4  * This program is free software; you can redistribute it and/or
   5  * modify it under the terms of the GNU General Public License
   6  * as published by the Free Software Foundation; either version
   7  * 2 of the License, or (at your option) any later version.
   8  */
   9 #include "nonstdio.h"
  10 #include "rs6000.h"
  11 #include "zlib.h"
  12
  13 extern void *finddevice(const char *);
  14 extern int getprop(void *, const char *, void *, int);
  15 void gunzip(void *, int, unsigned char *, int *);
  16
  17 #define get_16be(x)     (*(unsigned short *)(x))
  18 #define get_32be(x)     (*(unsigned *)(x))
  19
  20 #define RAM_START       0xc0000000
  21 #define PROG_START      RAM_START
  22 #define RAM_END         (RAM_START + 0x800000)  /* only 8M mapped with BATs */
  23
  24 #define RAM_FREE        (RAM_START + 0x540000)  /* after image of coffboot */
  25
  26 char *avail_ram;
  27 char *end_avail;
  28
  29 coffboot(int a1, int a2, void *prom)
  30 {
  31     void *options;
  32     unsigned loadbase;
  33     struct external_filehdr *eh;
  34     struct external_scnhdr *sp;
  35     struct external_scnhdr *isect, *rsect;
  36     int ns, oh, i;
  37     unsigned sa, len;
  38     void *dst;
  39     unsigned char *im;
  40     unsigned initrd_start, initrd_size;
  41
  42     printf("coffboot starting\n");
  43     options = finddevice("/options");
  44     if (options == (void *) -1)
  45         exit();
  46     if (getprop(options, "load-base", &loadbase, sizeof(loadbase))
  47         != sizeof(loadbase)) {
  48         printf("error getting load-base\n");
  49         exit();
  50     }
  51     setup_bats(RAM_START);
  52
  53     loadbase += RAM_START;
  54     eh = (struct external_filehdr *) loadbase;
  55     ns = get_16be(eh->f_nscns);
  56     oh = get_16be(eh->f_opthdr);
  57
  58     sp = (struct external_scnhdr *) (loadbase + sizeof(struct external_filehdr) + oh);
  59     isect = rsect = NULL;
  60     for (i = 0; i < ns; ++i, ++sp) {
  61         if (strcmp(sp->s_name, "image") == 0)
  62             isect = sp;
  63         else if (strcmp(sp->s_name, "initrd") == 0)
  64             rsect = sp;
  65     }
  66     if (isect == NULL) {
  67         printf("image section not found\n");
  68         exit();
  69     }
  70
  71     if (rsect != NULL && (initrd_size = get_32be(rsect->s_size)) != 0) {
  72         initrd_start = (RAM_END - initrd_size) & ~0xFFF;
  73         a1 = initrd_start;
  74         a2 = initrd_size;
  75         printf("initial ramdisk at %x (%u bytes)\n",
  76                initrd_start, initrd_size);
  77         memcpy((char *) initrd_start,
  78                (char *) (loadbase + get_32be(rsect->s_scnptr)),
  79                initrd_size);
  80         end_avail = (char *) initrd_start;
  81     } else {
  82         end_avail = (char *) RAM_END;
  83     }
  84
  85     im = (unsigned char *)(loadbase + get_32be(isect->s_scnptr));
  86     len = get_32be(isect->s_size);
  87     dst = (void *) PROG_START;
  88
  89     if (im[0] == 0x1f && im[1] == 0x8b) {
  90         void *cp = (void *) RAM_FREE;
  91         avail_ram = (void *) (RAM_FREE + ((len + 7) & -8));
  92         memcpy(cp, im, len);
  93         printf("gunzipping... ");
  94         gunzip(dst, 0x400000, cp, &len);
  95         printf("done\n");
  96
  97     } else {
  98         memmove(dst, im, len);
  99     }
 100
 101     flush_cache(dst, len);
 102
 103     sa = (unsigned long)dst;
 104     printf("start address = 0x%x\n", sa);
 105
 106 #if 0
 107     pause();
 108 #endif
 109     (*(void (*)())sa)(a1, a2, prom);
 110
 111     printf("returned?\n");
 112
 113     pause();
 114 }
 115
 116 void *zalloc(void *x, unsigned items, unsigned size)
 117 {
 118     void *p = avail_ram;
 119
 120     size *= items;
 121     size = (size + 7) & -8;
 122     avail_ram += size;
 123     if (avail_ram > end_avail) {
 124         printf("oops... out of memory\n");
 125         pause();
 126     }
 127     return p;
 128 }
 129
 130 void zfree(void *x, void *addr, unsigned nb)
 131 {
 132 }
 133
 134 #define HEAD_CRC        2
 135 #define EXTRA_FIELD     4
 136 #define ORIG_NAME       8
 137 #define COMMENT         0x10
 138 #define RESERVED        0xe0
 139
 140 #define DEFLATED        8
 141
 142 void gunzip(void *dst, int dstlen, unsigned char *src, int *lenp)
 143 {
 144     z_stream s;
 145     int r, i, flags;
 146
 147     /* skip header */
 148     i = 10;
 149     flags = src[3];
 150     if (src[2] != DEFLATED || (flags & RESERVED) != 0) {
 151         printf("bad gzipped data\n");
 152         exit();
 153     }
 154     if ((flags & EXTRA_FIELD) != 0)
 155         i = 12 + src[10] + (src[11] << 8);
 156     if ((flags & ORIG_NAME) != 0)
 157         while (src[i++] != 0)
 158             ;
 159     if ((flags & COMMENT) != 0)
 160         while (src[i++] != 0)
 161             ;
 162     if ((flags & HEAD_CRC) != 0)
 163         i += 2;
 164     if (i >= *lenp) {
 165         printf("gunzip: ran out of data in header\n");
 166         exit();
 167     }
 168 printf("done 1\n");
 169     s.zalloc = zalloc;
 170     s.zfree = zfree;
 171     r = inflateInit2(&s, -MAX_WBITS);
 172     if (r != Z_OK) {
 173         printf("inflateInit2 returned %d\n", r);
 174         exit();
 175     }
 176     s.next_in = src + i;
 177     s.avail_in = *lenp - i;
 178     s.next_out = dst;
 179     s.avail_out = dstlen;
 180 printf("doing inflate\n");
 181     r = inflate(&s, Z_FINISH);
 182 printf("done inflate\n");
 183     if (r != Z_OK && r != Z_STREAM_END) {
 184         printf("inflate returned %d\n", r);
 185         exit();
 186     }
 187     *lenp = s.next_out - (unsigned char *) dst;
 188 printf("doing end\n");
 189     inflateEnd(&s);
 190 }