powerpc: Fixes to get the Longtrail CHRP a bit further
[linux-3.10.git] / arch / ppc / boot / openfirmware / common.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
10 #include "nonstdio.h"
11 #include "of1275.h"
12 #include <linux/string.h>
13 #include <linux/zlib.h>
14 #include <asm/bootinfo.h>
15 #include <asm/page.h>
16
17 /* Information from the linker */
18
19 extern int strcmp(const char *s1, const char *s2);
20 extern char *avail_ram, *avail_high;
21 extern char *end_avail;
22
23 unsigned int heap_use, heap_max;
24
25 struct memchunk {
26     unsigned int size;
27     struct memchunk *next;
28 };
29
30 static struct memchunk *freechunks;
31
32 static void *zalloc(unsigned size)
33 {
34     void *p;
35     struct memchunk **mpp, *mp;
36
37     size = (size + 7) & -8;
38     heap_use += size;
39     if (heap_use > heap_max)
40         heap_max = heap_use;
41     for (mpp = &freechunks; (mp = *mpp) != 0; mpp = &mp->next) {
42         if (mp->size == size) {
43             *mpp = mp->next;
44             return mp;
45         }
46     }
47     p = avail_ram;
48     avail_ram += size;
49     if (avail_ram > avail_high)
50         avail_high = avail_ram;
51     if (avail_ram > end_avail) {
52         printf("oops... out of memory\n\r");
53         pause();
54     }
55     return p;
56 }
57
58 #define HEAD_CRC        2
59 #define EXTRA_FIELD     4
60 #define ORIG_NAME       8
61 #define COMMENT         0x10
62 #define RESERVED        0xe0
63
64 void gunzip(void *dst, int dstlen, unsigned char *src, int *lenp)
65 {
66         z_stream s;
67         int r, i, flags;
68
69         /* skip header */
70         i = 10;
71         flags = src[3];
72         if (src[2] != Z_DEFLATED || (flags & RESERVED) != 0) {
73                 printf("bad gzipped data\n\r");
74                 exit();
75         }
76         if ((flags & EXTRA_FIELD) != 0)
77                 i = 12 + src[10] + (src[11] << 8);
78         if ((flags & ORIG_NAME) != 0)
79                 while (src[i++] != 0)
80                         ;
81         if ((flags & COMMENT) != 0)
82                 while (src[i++] != 0)
83                         ;
84         if ((flags & HEAD_CRC) != 0)
85                 i += 2;
86         if (i >= *lenp) {
87                 printf("gunzip: ran out of data in header\n\r");
88                 exit();
89         }
90
91         /* Initialize ourself. */
92         s.workspace = zalloc(zlib_inflate_workspacesize());
93         r = zlib_inflateInit2(&s, -MAX_WBITS);
94         if (r != Z_OK) {
95                 printf("zlib_inflateInit2 returned %d\n\r", r);
96                 exit();
97         }
98         s.next_in = src + i;
99         s.avail_in = *lenp - i;
100         s.next_out = dst;
101         s.avail_out = dstlen;
102         r = zlib_inflate(&s, Z_FINISH);
103         if (r != Z_OK && r != Z_STREAM_END) {
104                 printf("inflate returned %d msg: %s\n\r", r, s.msg);
105                 exit();
106         }
107         *lenp = s.next_out - (unsigned char *) dst;
108         zlib_inflateEnd(&s);
109 }
110
111 /* Make a bi_rec in OF.  We need to be passed a name for BI_BOOTLOADER_ID,
112  * a machine type for BI_MACHTYPE, and the location where the end of the
113  * bootloader is (PROG_START + PROG_SIZE)
114  */
115 void make_bi_recs(unsigned long addr, char *name, unsigned int mach,
116                 unsigned long progend)
117 {
118         struct bi_record *rec;
119
120
121         /* leave a 1MB gap then align to the next 1MB boundary */
122         addr = _ALIGN(addr+ (1<<20) - 1, (1<<20));
123         /* oldworld machine seem very unhappy about this. -- Tom */
124         if (addr >= progend)
125                 claim(addr, 0x1000, 0);
126
127         rec = (struct bi_record *)addr;
128         rec->tag = BI_FIRST;
129         rec->size = sizeof(struct bi_record);
130         rec = (struct bi_record *)((unsigned long)rec + rec->size);
131
132         rec->tag = BI_BOOTLOADER_ID;
133         sprintf( (char *)rec->data, name);
134         rec->size = sizeof(struct bi_record) + strlen(name) + 1;
135         rec = (struct bi_record *)((unsigned long)rec + rec->size);
136
137         rec->tag = BI_MACHTYPE;
138         rec->data[0] = mach;
139         rec->data[1] = 1;
140         rec->size = sizeof(struct bi_record) + 2 * sizeof(unsigned long);
141         rec = (struct bi_record *)((unsigned long)rec + rec->size);
142
143         rec->tag = BI_LAST;
144         rec->size = sizeof(struct bi_record);
145         rec = (struct bi_record *)((unsigned long)rec + rec->size);
146 }