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