arch/riscv/lib/bootm.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2011 Andes Technology Corporation
   4  * Shawn Lin, Andes Technology Corporation <nobuhiro@andestech.com>
   5  * Macpaul Lin, Andes Technology Corporation <macpaul@andestech.com>
   6  * Rick Chen, Andes Technology Corporation <rick@andestech.com>
   7  */
   8
   9 #include <common.h>
  10 #include <bootstage.h>
  11 #include <command.h>
  12 #include <dm.h>
  13 #include <fdt_support.h>
  14 #include <hang.h>
  15 #include <log.h>
  16 #include <asm/global_data.h>
  17 #include <dm/root.h>
  18 #include <image.h>
  19 #include <asm/byteorder.h>
  20 #include <asm/csr.h>
  21 #include <asm/smp.h>
  22 #include <dm/device.h>
  23 #include <dm/root.h>
  24 #include <u-boot/zlib.h>
  25
  26 DECLARE_GLOBAL_DATA_PTR;
  27
  28 __weak void board_quiesce_devices(void)
  29 {
  30 }
  31
  32 /**
  33  * announce_and_cleanup() - Print message and prepare for kernel boot
  34  *
  35  * @fake: non-zero to do everything except actually boot
  36  */
  37 static void announce_and_cleanup(int fake)
  38 {
  39         printf("\nStarting kernel ...%s\n\n", fake ?
  40                 "(fake run for tracing)" : "");
  41         bootstage_mark_name(BOOTSTAGE_ID_BOOTM_HANDOFF, "start_kernel");
  42 #ifdef CONFIG_BOOTSTAGE_FDT
  43         bootstage_fdt_add_report();
  44 #endif
  45 #ifdef CONFIG_BOOTSTAGE_REPORT
  46         bootstage_report();
  47 #endif
  48
  49 #ifdef CONFIG_USB_DEVICE
  50         udc_disconnect();
  51 #endif
  52
  53         board_quiesce_devices();
  54
  55         /*
  56          * Call remove function of all devices with a removal flag set.
  57          * This may be useful for last-stage operations, like cancelling
  58          * of DMA operation or releasing device internal buffers.
  59          */
  60         dm_remove_devices_flags(DM_REMOVE_ACTIVE_ALL);
  61
  62         cleanup_before_linux();
  63 }
  64
  65 static void boot_prep_linux(struct bootm_headers *images)
  66 {
  67         if (CONFIG_IS_ENABLED(OF_LIBFDT) && IS_ENABLED(CONFIG_LMB) && images->ft_len) {
  68                 debug("using: FDT\n");
  69                 if (image_setup_linux(images)) {
  70                         printf("FDT creation failed! hanging...");
  71                         hang();
  72                 }
  73         } else {
  74                 printf("Device tree not found or missing FDT support\n");
  75                 hang();
  76         }
  77 }
  78
  79 static void boot_jump_linux(struct bootm_headers *images, int flag)
  80 {
  81         void (*kernel)(ulong hart, void *dtb);
  82         int fake = (flag & BOOTM_STATE_OS_FAKE_GO);
  83 #ifdef CONFIG_SMP
  84         int ret;
  85 #endif
  86
  87         kernel = (void (*)(ulong, void *))images->ep;
  88
  89         bootstage_mark(BOOTSTAGE_ID_RUN_OS);
  90
  91         debug("## Transferring control to kernel (at address %08lx) ...\n",
  92               (ulong)kernel);
  93
  94         announce_and_cleanup(fake);
  95
  96         if (!fake) {
  97                 if (CONFIG_IS_ENABLED(OF_LIBFDT) && images->ft_len) {
  98 #ifdef CONFIG_SMP
  99                         ret = smp_call_function(images->ep,
 100                                                 (ulong)images->ft_addr, 0, 0);
 101                         if (ret)
 102                                 hang();
 103 #endif
 104                         kernel(gd->arch.boot_hart, images->ft_addr);
 105                 }
 106         }
 107 }
 108
 109 int do_bootm_linux(int flag, int argc, char *const argv[],
 110                    struct bootm_headers *images)
 111 {
 112         /* No need for those on RISC-V */
 113         if (flag & BOOTM_STATE_OS_BD_T || flag & BOOTM_STATE_OS_CMDLINE)
 114                 return -1;
 115
 116         if (flag & BOOTM_STATE_OS_PREP) {
 117                 boot_prep_linux(images);
 118                 return 0;
 119         }
 120
 121         if (flag & (BOOTM_STATE_OS_GO | BOOTM_STATE_OS_FAKE_GO)) {
 122                 boot_jump_linux(images, flag);
 123                 return 0;
 124         }
 125
 126         boot_prep_linux(images);
 127         boot_jump_linux(images, flag);
 128         return 0;
 129 }
 130
 131 int do_bootm_vxworks(int flag, int argc, char *const argv[],
 132                      struct bootm_headers *images)
 133 {
 134         return do_bootm_linux(flag, argc, argv, images);
 135 }
 136
 137 static ulong get_sp(void)
 138 {
 139         ulong ret;
 140
 141         asm("mv %0, sp" : "=r"(ret) : );
 142         return ret;
 143 }
 144
 145 void arch_lmb_reserve(struct lmb *lmb)
 146 {
 147         arch_lmb_reserve_generic(lmb, get_sp(), gd->ram_top, 4096);
 148 }