arch/arm/mach-imx/imx_bootaux.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2016 Freescale Semiconductor, Inc.
   4  */
   5
   6 #include <common.h>
   7 #include <log.h>
   8 #include <asm/io.h>
   9 #include <asm/mach-imx/sys_proto.h>
  10 #include <command.h>
  11 #include <elf.h>
  12 #include <imx_sip.h>
  13 #include <linux/arm-smccc.h>
  14 #include <linux/compiler.h>
  15 #include <cpu_func.h>
  16
  17 int arch_auxiliary_core_up(u32 core_id, ulong addr)
  18 {
  19         ulong stack, pc;
  20
  21         if (!addr)
  22                 return -EINVAL;
  23
  24 #ifdef CONFIG_IMX8M
  25         stack = *(u32 *)addr;
  26         pc = *(u32 *)(addr + 4);
  27 #else
  28         /*
  29          * handling ELF64 binaries
  30          * isn't supported yet.
  31          */
  32         if (valid_elf_image(addr)) {
  33                 stack = 0x0;
  34                 pc = load_elf_image_phdr(addr);
  35                 if (!pc)
  36                         return CMD_RET_FAILURE;
  37
  38         } else {
  39                 /*
  40                  * Assume binary file with vector table at the beginning.
  41                  * Cortex-M4 vector tables start with the stack pointer (SP)
  42                  * and reset vector (initial PC).
  43                  */
  44                 stack = *(u32 *)addr;
  45                 pc = *(u32 *)(addr + 4);
  46         }
  47 #endif
  48         printf("## Starting auxiliary core stack = 0x%08lX, pc = 0x%08lX...\n",
  49                stack, pc);
  50
  51         /* Set the stack and pc to M4 bootROM */
  52         writel(stack, M4_BOOTROM_BASE_ADDR);
  53         writel(pc, M4_BOOTROM_BASE_ADDR + 4);
  54
  55         flush_dcache_all();
  56
  57         /* Enable M4 */
  58 #ifdef CONFIG_IMX8M
  59         arm_smccc_smc(IMX_SIP_SRC, IMX_SIP_SRC_M4_START, 0, 0,
  60                       0, 0, 0, 0, NULL);
  61 #else
  62         clrsetbits_le32(SRC_BASE_ADDR + SRC_M4_REG_OFFSET,
  63                         SRC_M4C_NON_SCLR_RST_MASK, SRC_M4_ENABLE_MASK);
  64 #endif
  65
  66         return 0;
  67 }
  68
  69 int arch_auxiliary_core_check_up(u32 core_id)
  70 {
  71 #ifdef CONFIG_IMX8M
  72         struct arm_smccc_res res;
  73
  74         arm_smccc_smc(IMX_SIP_SRC, IMX_SIP_SRC_M4_STARTED, 0, 0,
  75                       0, 0, 0, 0, &res);
  76
  77         return res.a0;
  78 #else
  79         unsigned int val;
  80
  81         val = readl(SRC_BASE_ADDR + SRC_M4_REG_OFFSET);
  82
  83         if (val & SRC_M4C_NON_SCLR_RST_MASK)
  84                 return 0;  /* assert in reset */
  85
  86         return 1;
  87 #endif
  88 }
  89
  90 /*
  91  * To i.MX6SX and i.MX7D, the image supported by bootaux needs
  92  * the reset vector at the head for the image, with SP and PC
  93  * as the first two words.
  94  *
  95  * Per the cortex-M reference manual, the reset vector of M4 needs
  96  * to exist at 0x0 (TCMUL). The PC and SP are the first two addresses
  97  * of that vector.  So to boot M4, the A core must build the M4's reset
  98  * vector with getting the PC and SP from image and filling them to
  99  * TCMUL. When M4 is kicked, it will load the PC and SP by itself.
 100  * The TCMUL is mapped to (M4_BOOTROM_BASE_ADDR) at A core side for
 101  * accessing the M4 TCMUL.
 102  */
 103 static int do_bootaux(struct cmd_tbl *cmdtp, int flag, int argc,
 104                       char *const argv[])
 105 {
 106         ulong addr;
 107         int ret, up;
 108
 109         if (argc < 2)
 110                 return CMD_RET_USAGE;
 111
 112         up = arch_auxiliary_core_check_up(0);
 113         if (up) {
 114                 printf("## Auxiliary core is already up\n");
 115                 return CMD_RET_SUCCESS;
 116         }
 117
 118         addr = simple_strtoul(argv[1], NULL, 16);
 119
 120         if (!addr)
 121                 return CMD_RET_FAILURE;
 122
 123         ret = arch_auxiliary_core_up(0, addr);
 124         if (ret)
 125                 return CMD_RET_FAILURE;
 126
 127         return CMD_RET_SUCCESS;
 128 }
 129
 130 U_BOOT_CMD(
 131         bootaux, CONFIG_SYS_MAXARGS, 1, do_bootaux,
 132         "Start auxiliary core",
 133         ""
 134 );