arch/mips/lib/bootm.c

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