src/soc/intel/baytrail/refcode.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2
   3 #include <cbmem.h>
   4 #include <console/console.h>
   5 #include <console/streams.h>
   6 #include <cpu/x86/tsc.h>
   7 #include <program_loading.h>
   8 #include <rmodule.h>
   9 #include <stage_cache.h>
  10
  11 #include <soc/ramstage.h>
  12 #include <soc/efi_wrapper.h>
  13
  14 static void ABI_X86 send_to_console(unsigned char b)
  15 {
  16         console_tx_byte(b);
  17 }
  18
  19 static efi_wrapper_entry_t load_reference_code(void)
  20 {
  21         if (resume_from_stage_cache()) {
  22                 struct prog prog;
  23                 stage_cache_load_stage(STAGE_REFCODE, &prog);
  24                 return prog_entry(&prog);
  25         }
  26
  27         struct prog prog =
  28                 PROG_INIT(PROG_REFCODE, CONFIG_CBFS_PREFIX "/refcode");
  29         struct rmod_stage_load refcode = {
  30                 .cbmem_id = CBMEM_ID_REFCODE,
  31                 .prog = &prog,
  32         };
  33
  34         if (rmodule_stage_load(&refcode)) {
  35                 printk(BIOS_DEBUG, "Error loading reference code.\n");
  36                 return NULL;
  37         }
  38
  39         /* Cache loaded reference code. */
  40         stage_cache_add(STAGE_REFCODE, &prog);
  41
  42         return prog_entry(&prog);
  43 }
  44
  45 void baytrail_run_reference_code(void)
  46 {
  47         int ret;
  48         efi_wrapper_entry_t entry;
  49         struct efi_wrapper_params wrp = {
  50                 .version = EFI_WRAPPER_VER,
  51                 .console_out = send_to_console,
  52         };
  53
  54         entry = load_reference_code();
  55
  56         if (entry == NULL)
  57                 return;
  58
  59         wrp.tsc_ticks_per_microsecond = tsc_freq_mhz();
  60
  61         /* Call into reference code. */
  62         ret = entry(&wrp);
  63
  64         if (ret != 0) {
  65                 printk(BIOS_DEBUG, "Reference code returned %d\n", ret);
  66                 return;
  67         }
  68 }