git.oblomov.eu Git - linux-2.6/blob - arch/arm/boot/compressed/ofw-shark.c

   1 /*
   2  * linux/arch/arm/boot/compressed/ofw-shark.c
   3  *
   4  * by Alexander Schulz
   5  *
   6  * This file is used to get some basic information
   7  * about the memory layout of the shark we are running
   8  * on. Memory is usually divided in blocks a 8 MB.
   9  * And bootargs are copied from OpenFirmware.
  10  */
  11
  12
  13 #include <linux/kernel.h>
  14 #include <linux/types.h>
  15 #include <asm/setup.h>
  16 #include <asm/page.h>
  17
  18
  19 asmlinkage void
  20 create_params (unsigned long *buffer)
  21 {
  22         /* Is there a better address? Also change in mach-shark/core.c */
  23         struct tag *tag = (struct tag *) 0x08003000;
  24         int j,i,m,k,nr_banks,size;
  25         unsigned char *c;
  26
  27         k = 0;
  28
  29         /* Head of the taglist */
  30         tag->hdr.tag  = ATAG_CORE;
  31         tag->hdr.size = tag_size(tag_core);
  32         tag->u.core.flags = 1;
  33         tag->u.core.pagesize = PAGE_SIZE;
  34         tag->u.core.rootdev = 0;
  35
  36         /* Build up one tagged block for each memory region */
  37         size=0;
  38         nr_banks=(unsigned int) buffer[0];
  39         for (j=0;j<nr_banks;j++){
  40                 /* search the lowest address and put it into the next entry   */
  41                 /* not a fast sort algorithm, but there are at most 8 entries */
  42                 /* and this is used only once anyway                          */
  43                 m=0xffffffff;
  44                 for (i=0;i<(unsigned int) buffer[0];i++){
  45                         if (buffer[2*i+1]<m) {
  46                                 m=buffer[2*i+1];
  47                                 k=i;
  48                         }
  49                 }
  50
  51                 tag = tag_next(tag);
  52                 tag->hdr.tag = ATAG_MEM;
  53                 tag->hdr.size = tag_size(tag_mem32);
  54                 tag->u.mem.size = buffer[2*k+2];
  55                 tag->u.mem.start = buffer[2*k+1];
  56
  57                 size += buffer[2*k+2];
  58
  59                 buffer[2*k+1]=0xffffffff;                    /* mark as copied */
  60         }
  61
  62         /* The command line */
  63         tag = tag_next(tag);
  64         tag->hdr.tag = ATAG_CMDLINE;
  65
  66         c=(unsigned char *)(&buffer[34]);
  67         j=0;
  68         while (*c) tag->u.cmdline.cmdline[j++]=*c++;
  69
  70         tag->u.cmdline.cmdline[j]=0;
  71         tag->hdr.size = (j + 7 + sizeof(struct tag_header)) >> 2;
  72
  73         /* Hardware revision */
  74         tag = tag_next(tag);
  75         tag->hdr.tag = ATAG_REVISION;
  76         tag->hdr.size = tag_size(tag_revision);
  77         tag->u.revision.rev = ((unsigned char) buffer[33])-'0';
  78
  79         /* End of the taglist */
  80         tag = tag_next(tag);
  81         tag->hdr.tag = 0;
  82         tag->hdr.size = 0;
  83 }
  84
  85
  86 typedef int (*ofw_handle_t)(void *);
  87
  88 /* Everything below is called with a wrong MMU setting.
  89  * This means: no string constants, no initialization of
  90  * arrays, no global variables! This is ugly but I didn't
  91  * want to write this in assembler :-)
  92  */
  93
  94 int
  95 of_decode_int(const unsigned char *p)
  96 {
  97         unsigned int i = *p++ << 8;
  98         i = (i + *p++) << 8;
  99         i = (i + *p++) << 8;
 100         return (i + *p);
 101 }
 102
 103 int
 104 OF_finddevice(ofw_handle_t openfirmware, char *name)
 105 {
 106         unsigned int args[8];
 107         char service[12];
 108
 109         service[0]='f';
 110         service[1]='i';
 111         service[2]='n';
 112         service[3]='d';
 113         service[4]='d';
 114         service[5]='e';
 115         service[6]='v';
 116         service[7]='i';
 117         service[8]='c';
 118         service[9]='e';
 119         service[10]='\0';
 120
 121         args[0]=(unsigned int)service;
 122         args[1]=1;
 123         args[2]=1;
 124         args[3]=(unsigned int)name;
 125
 126         if (openfirmware(args) == -1)
 127                 return -1;
 128         return args[4];
 129 }
 130
 131 int
 132 OF_getproplen(ofw_handle_t openfirmware, int handle, char *prop)
 133 {
 134         unsigned int args[8];
 135         char service[12];
 136
 137         service[0]='g';
 138         service[1]='e';
 139         service[2]='t';
 140         service[3]='p';
 141         service[4]='r';
 142         service[5]='o';
 143         service[6]='p';
 144         service[7]='l';
 145         service[8]='e';
 146         service[9]='n';
 147         service[10]='\0';
 148
 149         args[0] = (unsigned int)service;
 150         args[1] = 2;
 151         args[2] = 1;
 152         args[3] = (unsigned int)handle;
 153         args[4] = (unsigned int)prop;
 154
 155         if (openfirmware(args) == -1)
 156                 return -1;
 157         return args[5];
 158 }
 159
 160 int
 161 OF_getprop(ofw_handle_t openfirmware, int handle, char *prop, void *buf, unsigned int buflen)
 162 {
 163         unsigned int args[8];
 164         char service[8];
 165
 166         service[0]='g';
 167         service[1]='e';
 168         service[2]='t';
 169         service[3]='p';
 170         service[4]='r';
 171         service[5]='o';
 172         service[6]='p';
 173         service[7]='\0';
 174
 175         args[0] = (unsigned int)service;
 176         args[1] = 4;
 177         args[2] = 1;
 178         args[3] = (unsigned int)handle;
 179         args[4] = (unsigned int)prop;
 180         args[5] = (unsigned int)buf;
 181         args[6] = buflen;
 182
 183         if (openfirmware(args) == -1)
 184                 return -1;
 185         return args[7];
 186 }
 187
 188 asmlinkage void ofw_init(ofw_handle_t o, int *nomr, int *pointer)
 189 {
 190         int phandle,i,mem_len,buffer[32];
 191         char temp[15];
 192
 193         temp[0]='/';
 194         temp[1]='m';
 195         temp[2]='e';
 196         temp[3]='m';
 197         temp[4]='o';
 198         temp[5]='r';
 199         temp[6]='y';
 200         temp[7]='\0';
 201
 202         phandle=OF_finddevice(o,temp);
 203
 204         temp[0]='r';
 205         temp[1]='e';
 206         temp[2]='g';
 207         temp[3]='\0';
 208
 209         mem_len = OF_getproplen(o,phandle, temp);
 210         OF_getprop(o,phandle, temp, buffer, mem_len);
 211         *nomr=mem_len >> 3;
 212
 213         for (i=0; i<=mem_len/4; i++) pointer[i]=of_decode_int((const unsigned char *)&buffer[i]);
 214
 215         temp[0]='/';
 216         temp[1]='c';
 217         temp[2]='h';
 218         temp[3]='o';
 219         temp[4]='s';
 220         temp[5]='e';
 221         temp[6]='n';
 222         temp[7]='\0';
 223
 224         phandle=OF_finddevice(o,temp);
 225
 226         temp[0]='b';
 227         temp[1]='o';
 228         temp[2]='o';
 229         temp[3]='t';
 230         temp[4]='a';
 231         temp[5]='r';
 232         temp[6]='g';
 233         temp[7]='s';
 234         temp[8]='\0';
 235
 236         mem_len = OF_getproplen(o,phandle, temp);
 237         OF_getprop(o,phandle, temp, buffer, mem_len);
 238         if (mem_len > 128) mem_len=128;
 239         for (i=0; i<=mem_len/4; i++) pointer[i+33]=buffer[i];
 240         pointer[i+33]=0;
 241
 242         temp[0]='/';
 243         temp[1]='\0';
 244         phandle=OF_finddevice(o,temp);
 245         temp[0]='b';
 246         temp[1]='a';
 247         temp[2]='n';
 248         temp[3]='n';
 249         temp[4]='e';
 250         temp[5]='r';
 251         temp[6]='-';
 252         temp[7]='n';
 253         temp[8]='a';
 254         temp[9]='m';
 255         temp[10]='e';
 256         temp[11]='\0';
 257         mem_len = OF_getproplen(o,phandle, temp);
 258         OF_getprop(o,phandle, temp, buffer, mem_len);
 259         * ((unsigned char *) &pointer[32]) = ((unsigned char *) buffer)[mem_len-2];
 260 }