src/soc/qualcomm/sc7280/cpucp_load_reset.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2
   3 #include <assert.h>
   4 #include <console/console.h>
   5 #include <program_loading.h>
   6 #include <soc/mmu.h>
   7 #include <soc/cpucp.h>
   8 #include <soc/clock.h>
   9 #include <device/mmio.h>
  10 #include <timer.h>
  11
  12 void cpucp_prepare(void)
  13 {
  14         /* allow NS access to EPSS memory */
  15         setbits32(&epss_top->access_override, 0x1);
  16
  17         /* Enable subsystem clock. Required for CPUCP PDMEM access */
  18         setbits32(&epss_fast->epss_muc_clk_ctrl, 0x1);
  19 }
  20
  21 void cpucp_fw_load_reset(void)
  22 {
  23         struct prog cpucp_fw_prog =
  24                 PROG_INIT(PROG_PAYLOAD, CONFIG_CBFS_PREFIX "/cpucp");
  25
  26         if (!wait_ms(300, (read32(&epss_fast->epss_muc_clk_ctrl) & 0x1) == 0x1))
  27                 printk(BIOS_ERR, "%s: cannot get CPUCP PDMEM access.\n", __func__);
  28
  29         if (!selfload(&cpucp_fw_prog))
  30                 die("SOC image: CPUCP load failed");
  31
  32         printk(BIOS_DEBUG, "SOC:CPUCP image loaded successfully.\n");
  33 }