vaseboot/VasEBoot-core/efiemu/prepare.c

/* Prepare efiemu. E.g. allocate memory, load the runtime
   to appropriate place, etc */
/*
 *  VasEBoot  --  GRand Unified Bootloader
 *  Copyright (C) 2009  Free Software Foundation, Inc.
 *
 *  VasEBoot is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 *
 *  VasEBoot is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with VasEBoot.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <VasEBoot/err.h>
#include <VasEBoot/mm.h>
#include <VasEBoot/types.h>
#include <VasEBoot/misc.h>
#include <VasEBoot/efiemu/efiemu.h>
#include <VasEBoot/crypto.h>

VasEBoot_err_t
SUFFIX (VasEBoot_efiemu_prepare) (struct VasEBoot_efiemu_prepare_hook *prepare_hooks,
			      struct VasEBoot_efiemu_configuration_table
			      *config_tables)
{
  VasEBoot_err_t err;
  int conftable_handle;
  struct VasEBoot_efiemu_configuration_table *cur;
  struct VasEBoot_efiemu_prepare_hook *curhook;

  int cntconftables = 0;
  struct SUFFIX (VasEBoot_efiemu_configuration_table) *conftables = 0;
  int i;
  int handle;
  VasEBoot_off_t off;

  VasEBoot_dprintf ("efiemu", "Preparing EfiEmu\n");

  /* Request space for the list of configuration tables */
  for (cur = config_tables; cur; cur = cur->next)
    cntconftables++;
  conftable_handle
    = VasEBoot_efiemu_request_memalign (VasEBoot_EFIEMU_PAGESIZE,
				    cntconftables * sizeof (*conftables),
				    VasEBoot_EFI_RUNTIME_SERVICES_DATA);

  /* Switch from phase 1 (counting) to phase 2 (real job) */
  VasEBoot_efiemu_alloc_syms ();
  VasEBoot_efiemu_mm_do_alloc ();
  VasEBoot_efiemu_write_sym_markers ();

  VasEBoot_efiemu_system_table32 = 0;
  VasEBoot_efiemu_system_table64 = 0;

  /* Execute hooks */
  for (curhook = prepare_hooks; curhook; curhook = curhook->next)
    curhook->hook (curhook->data);

  /* Move runtime to its due place */
  err = VasEBoot_efiemu_loadcore_load ();
  if (err)
    {
      VasEBoot_efiemu_unload ();
      return err;
    }

  err = VasEBoot_efiemu_resolve_symbol ("efiemu_system_table", &handle, &off);
  if (err)
    {
      VasEBoot_efiemu_unload ();
      return err;
    }

  SUFFIX (VasEBoot_efiemu_system_table)
    = (struct SUFFIX (VasEBoot_efi_system_table) *)
    ((VasEBoot_uint8_t *) VasEBoot_efiemu_mm_obtain_request (handle) + off);

  /* Put pointer to the list of configuration tables in system table */
  err = VasEBoot_efiemu_write_value
	(&(SUFFIX (VasEBoot_efiemu_system_table)->configuration_table), 0,
	 conftable_handle, 0, 1,
	 sizeof (SUFFIX (VasEBoot_efiemu_system_table)->configuration_table));
  if (err)
    {
      VasEBoot_efiemu_unload ();
      return err;
    }

  SUFFIX(VasEBoot_efiemu_system_table)->num_table_entries = cntconftables;

  /* Fill the list of configuration tables */
  conftables = (struct SUFFIX (VasEBoot_efiemu_configuration_table) *)
    VasEBoot_efiemu_mm_obtain_request (conftable_handle);
  i = 0;
  for (cur = config_tables; cur; cur = cur->next, i++)
    {
      VasEBoot_memcpy (&(conftables[i].vendor_guid), &(cur->guid),
		       sizeof (cur->guid));
      if (cur->get_table)
	conftables[i].vendor_table = (VasEBoot_addr_t) cur->get_table (cur->data);
      else
	conftables[i].vendor_table = (VasEBoot_addr_t) cur->data;
    }

  err = SUFFIX (VasEBoot_efiemu_crc) ();
  if (err)
    {
      VasEBoot_efiemu_unload ();
      return err;
    }

  VasEBoot_dprintf ("efiemu","system_table = %p, conftables = %p (%d entries)\n",
		SUFFIX (VasEBoot_efiemu_system_table), conftables, cntconftables);

  return VasEBoot_ERR_NONE;
}

VasEBoot_err_t
SUFFIX (VasEBoot_efiemu_crc) (void)
{
  VasEBoot_err_t err;
  int handle;
  VasEBoot_off_t off;
  struct SUFFIX (VasEBoot_efiemu_runtime_services) *runtime_services;
  VasEBoot_uint32_t crc32_val;

  if (VasEBoot_MD_CRC32->mdlen != 4)
    return VasEBoot_error (VasEBoot_ERR_BUG, "incorrect mdlen");

  /* compute CRC32 of runtime_services */
  err = VasEBoot_efiemu_resolve_symbol ("efiemu_runtime_services",
				    &handle, &off);
  if (err)
    return err;

  runtime_services = (struct SUFFIX (VasEBoot_efiemu_runtime_services) *)
	((VasEBoot_uint8_t *) VasEBoot_efiemu_mm_obtain_request (handle) + off);

  runtime_services->hdr.crc32 = 0;

  VasEBoot_crypto_hash (VasEBoot_MD_CRC32, &crc32_val,
		    runtime_services, runtime_services->hdr.header_size);
  runtime_services->hdr.crc32 =
      VasEBoot_be_to_cpu32(crc32_val);

  err = VasEBoot_efiemu_resolve_symbol ("efiemu_system_table", &handle, &off);
  if (err)
    return err;

  /* compute CRC32 of system table */
  SUFFIX (VasEBoot_efiemu_system_table)->hdr.crc32 = 0;
  VasEBoot_crypto_hash (VasEBoot_MD_CRC32, &crc32_val,
		    SUFFIX (VasEBoot_efiemu_system_table),
		    SUFFIX (VasEBoot_efiemu_system_table)->hdr.header_size);
  SUFFIX (VasEBoot_efiemu_system_table)->hdr.crc32 =
      VasEBoot_be_to_cpu32(crc32_val);

  VasEBoot_dprintf ("efiemu","system_table = %p, runtime_services = %p\n",
		SUFFIX (VasEBoot_efiemu_system_table), runtime_services);

  return VasEBoot_ERR_NONE;
}