arch/mips/lib/bootm.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2003
   4  * Wolfgang Denk, DENX Software Engineering, [email protected].
   5  */
   6
   7 #include <common.h>
   8 #include <image.h>
   9 #include <fdt_support.h>
  10 #include <asm/addrspace.h>
  11 #include <asm/io.h>
  12
  13 DECLARE_GLOBAL_DATA_PTR;
  14
  15 #define LINUX_MAX_ENVS          256
  16 #define LINUX_MAX_ARGS          256
  17
  18 static int linux_argc;
  19 static char **linux_argv;
  20 static char *linux_argp;
  21
  22 static char **linux_env;
  23 static char *linux_env_p;
  24 static int linux_env_idx;
  25
  26 static ulong arch_get_sp(void)
  27 {
  28         ulong ret;
  29
  30         __asm__ __volatile__("move %0, $sp" : "=r"(ret) : );
  31
  32         return ret;
  33 }
  34
  35 void arch_lmb_reserve(struct lmb *lmb)
  36 {
  37         ulong sp;
  38
  39         sp = arch_get_sp();
  40         debug("## Current stack ends at 0x%08lx\n", sp);
  41
  42         /* adjust sp by 4K to be safe */
  43         sp -= 4096;
  44         lmb_reserve(lmb, sp, gd->ram_top - sp);
  45 }
  46
  47 static void linux_cmdline_init(void)
  48 {
  49         linux_argc = 1;
  50         linux_argv = (char **)UNCACHED_SDRAM(gd->bd->bi_boot_params);
  51         linux_argv[0] = 0;
  52         linux_argp = (char *)(linux_argv + LINUX_MAX_ARGS);
  53 }
  54
  55 static void linux_cmdline_set(const char *value, size_t len)
  56 {
  57         linux_argv[linux_argc] = linux_argp;
  58         memcpy(linux_argp, value, len);
  59         linux_argp[len] = 0;
  60
  61         linux_argp += len + 1;
  62         linux_argc++;
  63 }
  64
  65 static void linux_cmdline_dump(void)
  66 {
  67         int i;
  68
  69         debug("## cmdline argv at 0x%p, argp at 0x%p\n",
  70               linux_argv, linux_argp);
  71
  72         for (i = 1; i < linux_argc; i++)
  73                 debug("   arg %03d: %s\n", i, linux_argv[i]);
  74 }
  75
  76 static void linux_cmdline_legacy(bootm_headers_t *images)
  77 {
  78         const char *bootargs, *next, *quote;
  79
  80         linux_cmdline_init();
  81
  82         bootargs = env_get("bootargs");
  83         if (!bootargs)
  84                 return;
  85
  86         next = bootargs;
  87
  88         while (bootargs && *bootargs && linux_argc < LINUX_MAX_ARGS) {
  89                 quote = strchr(bootargs, '"');
  90                 next = strchr(bootargs, ' ');
  91
  92                 while (next && quote && quote < next) {
  93                         /*
  94                          * we found a left quote before the next blank
  95                          * now we have to find the matching right quote
  96                          */
  97                         next = strchr(quote + 1, '"');
  98                         if (next) {
  99                                 quote = strchr(next + 1, '"');
 100                                 next = strchr(next + 1, ' ');
 101                         }
 102                 }
 103
 104                 if (!next)
 105                         next = bootargs + strlen(bootargs);
 106
 107                 linux_cmdline_set(bootargs, next - bootargs);
 108
 109                 if (*next)
 110                         next++;
 111
 112                 bootargs = next;
 113         }
 114 }
 115
 116 static void linux_cmdline_append(bootm_headers_t *images)
 117 {
 118         char buf[24];
 119         ulong mem, rd_start, rd_size;
 120
 121         /* append mem */
 122         mem = gd->ram_size >> 20;
 123         sprintf(buf, "mem=%luM", mem);
 124         linux_cmdline_set(buf, strlen(buf));
 125
 126         /* append rd_start and rd_size */
 127         rd_start = images->initrd_start;
 128         rd_size = images->initrd_end - images->initrd_start;
 129
 130         if (rd_size) {
 131                 sprintf(buf, "rd_start=0x%08lX", rd_start);
 132                 linux_cmdline_set(buf, strlen(buf));
 133                 sprintf(buf, "rd_size=0x%lX", rd_size);
 134                 linux_cmdline_set(buf, strlen(buf));
 135         }
 136 }
 137
 138 static void linux_env_init(void)
 139 {
 140         linux_env = (char **)(((ulong) linux_argp + 15) & ~15);
 141         linux_env[0] = 0;
 142         linux_env_p = (char *)(linux_env + LINUX_MAX_ENVS);
 143         linux_env_idx = 0;
 144 }
 145
 146 static void linux_env_set(const char *env_name, const char *env_val)
 147 {
 148         if (linux_env_idx < LINUX_MAX_ENVS - 1) {
 149                 linux_env[linux_env_idx] = linux_env_p;
 150
 151                 strcpy(linux_env_p, env_name);
 152                 linux_env_p += strlen(env_name);
 153
 154                 if (CONFIG_IS_ENABLED(MALTA)) {
 155                         linux_env_p++;
 156                         linux_env[++linux_env_idx] = linux_env_p;
 157                 } else {
 158                         *linux_env_p++ = '=';
 159                 }
 160
 161                 strcpy(linux_env_p, env_val);
 162                 linux_env_p += strlen(env_val);
 163
 164                 linux_env_p++;
 165                 linux_env[++linux_env_idx] = 0;
 166         }
 167 }
 168
 169 static void linux_env_legacy(bootm_headers_t *images)
 170 {
 171         char env_buf[12];
 172         const char *cp;
 173         ulong rd_start, rd_size;
 174
 175         if (CONFIG_IS_ENABLED(MEMSIZE_IN_BYTES)) {
 176                 sprintf(env_buf, "%lu", (ulong)gd->ram_size);
 177                 debug("## Giving linux memsize in bytes, %lu\n",
 178                       (ulong)gd->ram_size);
 179         } else {
 180                 sprintf(env_buf, "%lu", (ulong)(gd->ram_size >> 20));
 181                 debug("## Giving linux memsize in MB, %lu\n",
 182                       (ulong)(gd->ram_size >> 20));
 183         }
 184
 185         rd_start = UNCACHED_SDRAM(images->initrd_start);
 186         rd_size = images->initrd_end - images->initrd_start;
 187
 188         linux_env_init();
 189
 190         linux_env_set("memsize", env_buf);
 191
 192         sprintf(env_buf, "0x%08lX", rd_start);
 193         linux_env_set("initrd_start", env_buf);
 194
 195         sprintf(env_buf, "0x%lX", rd_size);
 196         linux_env_set("initrd_size", env_buf);
 197
 198         sprintf(env_buf, "0x%08X", (uint) (gd->bd->bi_flashstart));
 199         linux_env_set("flash_start", env_buf);
 200
 201         sprintf(env_buf, "0x%X", (uint) (gd->bd->bi_flashsize));
 202         linux_env_set("flash_size", env_buf);
 203
 204         cp = env_get("ethaddr");
 205         if (cp)
 206                 linux_env_set("ethaddr", cp);
 207
 208         cp = env_get("eth1addr");
 209         if (cp)
 210                 linux_env_set("eth1addr", cp);
 211
 212         if (CONFIG_IS_ENABLED(MALTA)) {
 213                 sprintf(env_buf, "%un8r", gd->baudrate);
 214                 linux_env_set("modetty0", env_buf);
 215         }
 216 }
 217
 218 static int boot_reloc_fdt(bootm_headers_t *images)
 219 {
 220         /*
 221          * In case of legacy uImage's, relocation of FDT is already done
 222          * by do_bootm_states() and should not repeated in 'bootm prep'.
 223          */
 224         if (images->state & BOOTM_STATE_FDT) {
 225                 debug("## FDT already relocated\n");
 226                 return 0;
 227         }
 228
 229 #if CONFIG_IS_ENABLED(MIPS_BOOT_FDT) && CONFIG_IS_ENABLED(OF_LIBFDT)
 230         boot_fdt_add_mem_rsv_regions(&images->lmb, images->ft_addr);
 231         return boot_relocate_fdt(&images->lmb, &images->ft_addr,
 232                 &images->ft_len);
 233 #else
 234         return 0;
 235 #endif
 236 }
 237
 238 #if CONFIG_IS_ENABLED(MIPS_BOOT_FDT) && CONFIG_IS_ENABLED(OF_LIBFDT)
 239 int arch_fixup_fdt(void *blob)
 240 {
 241         u64 mem_start = virt_to_phys((void *)gd->bd->bi_memstart);
 242         u64 mem_size = gd->ram_size;
 243
 244         return fdt_fixup_memory_banks(blob, &mem_start, &mem_size, 1);
 245 }
 246 #endif
 247
 248 static int boot_setup_fdt(bootm_headers_t *images)
 249 {
 250         return image_setup_libfdt(images, images->ft_addr, images->ft_len,
 251                 &images->lmb);
 252 }
 253
 254 static void boot_prep_linux(bootm_headers_t *images)
 255 {
 256         if (CONFIG_IS_ENABLED(MIPS_BOOT_FDT) && images->ft_len) {
 257                 boot_reloc_fdt(images);
 258                 boot_setup_fdt(images);
 259         } else {
 260                 if (CONFIG_IS_ENABLED(MIPS_BOOT_CMDLINE_LEGACY)) {
 261                         linux_cmdline_legacy(images);
 262
 263                         if (!CONFIG_IS_ENABLED(MIPS_BOOT_ENV_LEGACY))
 264                                 linux_cmdline_append(images);
 265
 266                         linux_cmdline_dump();
 267                 }
 268
 269                 if (CONFIG_IS_ENABLED(MIPS_BOOT_ENV_LEGACY))
 270                         linux_env_legacy(images);
 271         }
 272 }
 273
 274 static void boot_jump_linux(bootm_headers_t *images)
 275 {
 276         typedef void __noreturn (*kernel_entry_t)(int, ulong, ulong, ulong);
 277         kernel_entry_t kernel = (kernel_entry_t) images->ep;
 278         ulong linux_extra = 0;
 279
 280         debug("## Transferring control to Linux (at address %p) ...\n", kernel);
 281
 282         bootstage_mark(BOOTSTAGE_ID_RUN_OS);
 283
 284         if (CONFIG_IS_ENABLED(MALTA))
 285                 linux_extra = gd->ram_size;
 286
 287 #if CONFIG_IS_ENABLED(BOOTSTAGE_FDT)
 288         bootstage_fdt_add_report();
 289 #endif
 290 #if CONFIG_IS_ENABLED(BOOTSTAGE_REPORT)
 291         bootstage_report();
 292 #endif
 293
 294         if (images->ft_len)
 295                 kernel(-2, (ulong)images->ft_addr, 0, 0);
 296         else
 297                 kernel(linux_argc, (ulong)linux_argv, (ulong)linux_env,
 298                         linux_extra);
 299 }
 300
 301 int do_bootm_linux(int flag, int argc, char * const argv[],
 302                         bootm_headers_t *images)
 303 {
 304         /* No need for those on MIPS */
 305         if (flag & BOOTM_STATE_OS_BD_T)
 306                 return -1;
 307
 308         /*
 309          * Cmdline init has been moved to 'bootm prep' because it has to be
 310          * done after relocation of ramdisk to always pass correct values
 311          * for rd_start and rd_size to Linux kernel.
 312          */
 313         if (flag & BOOTM_STATE_OS_CMDLINE)
 314                 return 0;
 315
 316         if (flag & BOOTM_STATE_OS_PREP) {
 317                 boot_prep_linux(images);
 318                 return 0;
 319         }
 320
 321         if (flag & (BOOTM_STATE_OS_GO | BOOTM_STATE_OS_FAKE_GO)) {
 322                 boot_jump_linux(images);
 323                 return 0;
 324         }
 325
 326         /* does not return */
 327         return 1;
 328 }