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