x86: EFI runtime service support (5b83683f) · Commits · e / devices / android_kernel_samsung_universal8895

arch/x86/Kconfig

+1 −1

Original line number	Diff line number	Diff line
		@@ -959,7 +959,7 @@ config MTRR
		config EFI
		def_bool n
		prompt "Boot from EFI support"
		depends on X86_32 && ACPI
		depends on ACPI
		---help---
		This enables the kernel to boot on EFI platforms using
		system configuration information passed to it from the firmware.

arch/x86/kernel/Makefile_64

+1 −0

Original line number	Diff line number	Diff line
		@@ -39,6 +39,7 @@ obj-$(CONFIG_X86_PM_TIMER) += pmtimer_64.o
		obj-$(CONFIG_X86_VSMP) += vsmp_64.o
		obj-$(CONFIG_K8_NB) += k8.o
		obj-$(CONFIG_AUDIT) += audit_64.o
		obj-$(CONFIG_EFI) += efi.o efi_64.o efi_stub_64.o

		obj-$(CONFIG_MODULES) += module_64.o
		obj-$(CONFIG_PCI) += early-quirks.o

arch/x86/kernel/efi.c

0 → 100644

+480 −0

Original line number	Diff line number	Diff line
		/*
		* Common EFI (Extensible Firmware Interface) support functions
		* Based on Extensible Firmware Interface Specification version 1.0
		*
		* Copyright (C) 1999 VA Linux Systems
		* Copyright (C) 1999 Walt Drummond <drummond@valinux.com>
		* Copyright (C) 1999-2002 Hewlett-Packard Co.
		* David Mosberger-Tang <davidm@hpl.hp.com>
		* Stephane Eranian <eranian@hpl.hp.com>
		* Copyright (C) 2005-2008 Intel Co.
		* Fenghua Yu <fenghua.yu@intel.com>
		* Bibo Mao <bibo.mao@intel.com>
		* Chandramouli Narayanan <mouli@linux.intel.com>
		* Huang Ying <ying.huang@intel.com>
		*
		* Copied from efi_32.c to eliminate the duplicated code between EFI
		* 32/64 support code. --ying 2007-10-26
		*
		* All EFI Runtime Services are not implemented yet as EFI only
		* supports physical mode addressing on SoftSDV. This is to be fixed
		* in a future version. --drummond 1999-07-20
		*
		* Implemented EFI runtime services and virtual mode calls. --davidm
		*
		* Goutham Rao: <goutham.rao@intel.com>
		* Skip non-WB memory and ignore empty memory ranges.
		*/

		#include <linux/kernel.h>
		#include <linux/init.h>
		#include <linux/efi.h>
		#include <linux/bootmem.h>
		#include <linux/spinlock.h>
		#include <linux/uaccess.h>
		#include <linux/time.h>
		#include <linux/io.h>
		#include <linux/reboot.h>
		#include <linux/bcd.h>

		#include <asm/setup.h>
		#include <asm/efi.h>
		#include <asm/time.h>

		#define EFI_DEBUG 1
		#define PFX "EFI: "

		int efi_enabled;
		EXPORT_SYMBOL(efi_enabled);

		struct efi efi;
		EXPORT_SYMBOL(efi);

		struct efi_memory_map memmap;

		struct efi efi_phys __initdata;
		static efi_system_table_t efi_systab __initdata;

		static efi_status_t virt_efi_get_time(efi_time_t tm, efi_time_cap_t tc)
		{
		return efi_call_virt2(get_time, tm, tc);
		}

		static efi_status_t virt_efi_set_time(efi_time_t *tm)
		{
		return efi_call_virt1(set_time, tm);
		}

		static efi_status_t virt_efi_get_wakeup_time(efi_bool_t *enabled,
		efi_bool_t *pending,
		efi_time_t *tm)
		{
		return efi_call_virt3(get_wakeup_time,
		enabled, pending, tm);
		}

		static efi_status_t virt_efi_set_wakeup_time(efi_bool_t enabled, efi_time_t *tm)
		{
		return efi_call_virt2(set_wakeup_time,
		enabled, tm);
		}

		static efi_status_t virt_efi_get_variable(efi_char16_t *name,
		efi_guid_t *vendor,
		u32 *attr,
		unsigned long *data_size,
		void *data)
		{
		return efi_call_virt5(get_variable,
		name, vendor, attr,
		data_size, data);
		}

		static efi_status_t virt_efi_get_next_variable(unsigned long *name_size,
		efi_char16_t *name,
		efi_guid_t *vendor)
		{
		return efi_call_virt3(get_next_variable,
		name_size, name, vendor);
		}

		static efi_status_t virt_efi_set_variable(efi_char16_t *name,
		efi_guid_t *vendor,
		unsigned long attr,
		unsigned long data_size,
		void *data)
		{
		return efi_call_virt5(set_variable,
		name, vendor, attr,
		data_size, data);
		}

		static efi_status_t virt_efi_get_next_high_mono_count(u32 *count)
		{
		return efi_call_virt1(get_next_high_mono_count, count);
		}

		static void virt_efi_reset_system(int reset_type,
		efi_status_t status,
		unsigned long data_size,
		efi_char16_t *data)
		{
		efi_call_virt4(reset_system, reset_type, status,
		data_size, data);
		}

		static efi_status_t virt_efi_set_virtual_address_map(
		unsigned long memory_map_size,
		unsigned long descriptor_size,
		u32 descriptor_version,
		efi_memory_desc_t *virtual_map)
		{
		return efi_call_virt4(set_virtual_address_map,
		memory_map_size, descriptor_size,
		descriptor_version, virtual_map);
		}

		static efi_status_t __init phys_efi_set_virtual_address_map(
		unsigned long memory_map_size,
		unsigned long descriptor_size,
		u32 descriptor_version,
		efi_memory_desc_t *virtual_map)
		{
		efi_status_t status;

		efi_call_phys_prelog();
		status = efi_call_phys4(efi_phys.set_virtual_address_map,
		memory_map_size, descriptor_size,
		descriptor_version, virtual_map);
		efi_call_phys_epilog();
		return status;
		}

		static efi_status_t __init phys_efi_get_time(efi_time_t *tm,
		efi_time_cap_t *tc)
		{
		efi_status_t status;

		efi_call_phys_prelog();
		status = efi_call_phys2(efi_phys.get_time, tm, tc);
		efi_call_phys_epilog();
		return status;
		}

		int efi_set_rtc_mmss(unsigned long nowtime)
		{
		int real_seconds, real_minutes;
		efi_status_t status;
		efi_time_t eft;
		efi_time_cap_t cap;

		status = efi.get_time(&eft, &cap);
		if (status != EFI_SUCCESS) {
		printk(KERN_ERR "Oops: efitime: can't read time!\n");
		return -1;
		}

		real_seconds = nowtime % 60;
		real_minutes = nowtime / 60;
		if (((abs(real_minutes - eft.minute) + 15)/30) & 1)
		real_minutes += 30;
		real_minutes %= 60;
		eft.minute = real_minutes;
		eft.second = real_seconds;

		status = efi.set_time(&eft);
		if (status != EFI_SUCCESS) {
		printk(KERN_ERR "Oops: efitime: can't write time!\n");
		return -1;
		}
		return 0;
		}

		unsigned long efi_get_time(void)
		{
		efi_status_t status;
		efi_time_t eft;
		efi_time_cap_t cap;

		status = efi.get_time(&eft, &cap);
		if (status != EFI_SUCCESS)
		printk(KERN_ERR "Oops: efitime: can't read time!\n");

		return mktime(eft.year, eft.month, eft.day, eft.hour,
		eft.minute, eft.second);
		}

		#if EFI_DEBUG
		static void __init print_efi_memmap(void)
		{
		efi_memory_desc_t *md;
		void *p;
		int i;

		for (p = memmap.map, i = 0;
		p < memmap.map_end;
		p += memmap.desc_size, i++) {
		md = p;
		printk(KERN_INFO PFX "mem%02u: type=%u, attr=0x%llx, "
		"range=[0x%016llx-0x%016llx) (%lluMB)\n",
		i, md->type, md->attribute, md->phys_addr,
		md->phys_addr + (md->num_pages << EFI_PAGE_SHIFT),
		(md->num_pages >> (20 - EFI_PAGE_SHIFT)));
		}
		}
		#endif /* EFI_DEBUG */

		void __init efi_init(void)
		{
		efi_config_table_t *config_tables;
		efi_runtime_services_t *runtime;
		efi_char16_t *c16;
		char vendor[100] = "unknown";
		int i = 0;
		void *tmp;

		#ifdef CONFIG_X86_32
		efi_phys.systab = (efi_system_table_t *)boot_params.efi_info.efi_systab;
		memmap.phys_map = (void *)boot_params.efi_info.efi_memmap;
		#else
		efi_phys.systab = (efi_system_table_t *)
		(boot_params.efi_info.efi_systab \|
		((__u64)boot_params.efi_info.efi_systab_hi<<32));
		memmap.phys_map = (void *)
		(boot_params.efi_info.efi_memmap \|
		((__u64)boot_params.efi_info.efi_memmap_hi<<32));
		#endif
		memmap.nr_map = boot_params.efi_info.efi_memmap_size /
		boot_params.efi_info.efi_memdesc_size;
		memmap.desc_version = boot_params.efi_info.efi_memdesc_version;
		memmap.desc_size = boot_params.efi_info.efi_memdesc_size;

		efi.systab = efi_early_ioremap((unsigned long)efi_phys.systab,
		sizeof(efi_system_table_t));
		if (efi.systab == NULL)
		printk(KERN_ERR "Couldn't map the EFI system table!\n");
		memcpy(&efi_systab, efi.systab, sizeof(efi_system_table_t));
		efi_early_iounmap(efi.systab, sizeof(efi_system_table_t));
		efi.systab = &efi_systab;

		/*
		* Verify the EFI Table
		*/
		if (efi.systab->hdr.signature != EFI_SYSTEM_TABLE_SIGNATURE)
		printk(KERN_ERR "EFI system table signature incorrect!\n");
		if ((efi.systab->hdr.revision >> 16) == 0)
		printk(KERN_ERR "Warning: EFI system table version "
		"%d.%02d, expected 1.00 or greater!\n",
		efi.systab->hdr.revision >> 16,
		efi.systab->hdr.revision & 0xffff);

		/*
		* Show what we know for posterity
		*/
		c16 = tmp = efi_early_ioremap(efi.systab->fw_vendor, 2);
		if (c16) {
		for (i = 0; i < sizeof(vendor) && *c16; ++i)
		vendor[i] = *c16++;
		vendor[i] = '\0';
		} else
		printk(KERN_ERR PFX "Could not map the firmware vendor!\n");
		efi_early_iounmap(tmp, 2);

		printk(KERN_INFO "EFI v%u.%.02u by %s \n",
		efi.systab->hdr.revision >> 16,
		efi.systab->hdr.revision & 0xffff, vendor);

		/*
		* Let's see what config tables the firmware passed to us.
		*/
		config_tables = efi_early_ioremap(
		efi.systab->tables,
		efi.systab->nr_tables * sizeof(efi_config_table_t));
		if (config_tables == NULL)
		printk(KERN_ERR "Could not map EFI Configuration Table!\n");

		printk(KERN_INFO);
		for (i = 0; i < efi.systab->nr_tables; i++) {
		if (!efi_guidcmp(config_tables[i].guid, MPS_TABLE_GUID)) {
		efi.mps = config_tables[i].table;
		printk(" MPS=0x%lx ", config_tables[i].table);
		} else if (!efi_guidcmp(config_tables[i].guid,
		ACPI_20_TABLE_GUID)) {
		efi.acpi20 = config_tables[i].table;
		printk(" ACPI 2.0=0x%lx ", config_tables[i].table);
		} else if (!efi_guidcmp(config_tables[i].guid,
		ACPI_TABLE_GUID)) {
		efi.acpi = config_tables[i].table;
		printk(" ACPI=0x%lx ", config_tables[i].table);
		} else if (!efi_guidcmp(config_tables[i].guid,
		SMBIOS_TABLE_GUID)) {
		efi.smbios = config_tables[i].table;
		printk(" SMBIOS=0x%lx ", config_tables[i].table);
		} else if (!efi_guidcmp(config_tables[i].guid,
		HCDP_TABLE_GUID)) {
		efi.hcdp = config_tables[i].table;
		printk(" HCDP=0x%lx ", config_tables[i].table);
		} else if (!efi_guidcmp(config_tables[i].guid,
		UGA_IO_PROTOCOL_GUID)) {
		efi.uga = config_tables[i].table;
		printk(" UGA=0x%lx ", config_tables[i].table);
		}
		}
		printk("\n");
		efi_early_iounmap(config_tables,
		efi.systab->nr_tables * sizeof(efi_config_table_t));

		/*
		* Check out the runtime services table. We need to map
		* the runtime services table so that we can grab the physical
		* address of several of the EFI runtime functions, needed to
		* set the firmware into virtual mode.
		*/
		runtime = efi_early_ioremap((unsigned long)efi.systab->runtime,
		sizeof(efi_runtime_services_t));
		if (runtime != NULL) {
		/*
		* We will only need early access to the following
		* two EFI runtime services before set_virtual_address_map
		* is invoked.
		*/
		efi_phys.get_time = (efi_get_time_t *)runtime->get_time;
		efi_phys.set_virtual_address_map =
		(efi_set_virtual_address_map_t *)
		runtime->set_virtual_address_map;
		/*
		* Make efi_get_time can be called before entering
		* virtual mode.
		*/
		efi.get_time = phys_efi_get_time;
		} else
		printk(KERN_ERR "Could not map the EFI runtime service "
		"table!\n");
		efi_early_iounmap(runtime, sizeof(efi_runtime_services_t));

		/* Map the EFI memory map */
		memmap.map = efi_early_ioremap((unsigned long)memmap.phys_map,
		memmap.nr_map * memmap.desc_size);
		if (memmap.map == NULL)
		printk(KERN_ERR "Could not map the EFI memory map!\n");
		memmap.map_end = memmap.map + (memmap.nr_map * memmap.desc_size);
		if (memmap.desc_size != sizeof(efi_memory_desc_t))
		printk(KERN_WARNING "Kernel-defined memdesc"
		"doesn't match the one from EFI!\n");

		#ifdef CONFIG_X86_64
		/* Setup for EFI runtime service */
		reboot_type = BOOT_EFI;

		#endif
		#if EFI_DEBUG
		print_efi_memmap();
		#endif
		}

		/*
		* This function will switch the EFI runtime services to virtual mode.
		* Essentially, look through the EFI memmap and map every region that
		* has the runtime attribute bit set in its memory descriptor and update
		* that memory descriptor with the virtual address obtained from ioremap().
		* This enables the runtime services to be called without having to
		* thunk back into physical mode for every invocation.
		*/
		void __init efi_enter_virtual_mode(void)
		{
		efi_memory_desc_t *md;
		efi_status_t status;
		unsigned long end;
		void *p;

		efi.systab = NULL;
		for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
		md = p;
		if (!(md->attribute & EFI_MEMORY_RUNTIME))
		continue;
		if ((md->attribute & EFI_MEMORY_WB) &&
		(((md->phys_addr + (md->num_pages<<EFI_PAGE_SHIFT)) >>
		PAGE_SHIFT) < end_pfn_map))
		md->virt_addr = (unsigned long)__va(md->phys_addr);
		else
		md->virt_addr = (unsigned long)
		efi_ioremap(md->phys_addr,
		md->num_pages << EFI_PAGE_SHIFT);
		if (!md->virt_addr)
		printk(KERN_ERR PFX "ioremap of 0x%llX failed!\n",
		(unsigned long long)md->phys_addr);
		end = md->phys_addr + (md->num_pages << EFI_PAGE_SHIFT);
		if ((md->phys_addr <= (unsigned long)efi_phys.systab) &&
		((unsigned long)efi_phys.systab < end))
		efi.systab = (efi_system_table_t *)(unsigned long)
		(md->virt_addr - md->phys_addr +
		(unsigned long)efi_phys.systab);
		}

		BUG_ON(!efi.systab);

		status = phys_efi_set_virtual_address_map(
		memmap.desc_size * memmap.nr_map,
		memmap.desc_size,
		memmap.desc_version,
		memmap.phys_map);

		if (status != EFI_SUCCESS) {
		printk(KERN_ALERT "Unable to switch EFI into virtual mode "
		"(status=%lx)!\n", status);
		panic("EFI call to SetVirtualAddressMap() failed!");
		}

		/*
		* Now that EFI is in virtual mode, update the function
		* pointers in the runtime service table to the new virtual addresses.
		*
		* Call EFI services through wrapper functions.
		*/
		efi.get_time = virt_efi_get_time;
		efi.set_time = virt_efi_set_time;
		efi.get_wakeup_time = virt_efi_get_wakeup_time;
		efi.set_wakeup_time = virt_efi_set_wakeup_time;
		efi.get_variable = virt_efi_get_variable;
		efi.get_next_variable = virt_efi_get_next_variable;
		efi.set_variable = virt_efi_set_variable;
		efi.get_next_high_mono_count = virt_efi_get_next_high_mono_count;
		efi.reset_system = virt_efi_reset_system;
		efi.set_virtual_address_map = virt_efi_set_virtual_address_map;
		#ifdef CONFIG_X86_64
		runtime_code_page_mkexec();
		#endif
		}

		/*
		* Convenience functions to obtain memory types and attributes
		*/
		u32 efi_mem_type(unsigned long phys_addr)
		{
		efi_memory_desc_t *md;
		void *p;

		for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
		md = p;
		if ((md->phys_addr <= phys_addr) &&
		(phys_addr < (md->phys_addr +
		(md->num_pages << EFI_PAGE_SHIFT))))
		return md->type;
		}
		return 0;
		}

		u64 efi_mem_attributes(unsigned long phys_addr)
		{
		efi_memory_desc_t *md;
		void *p;

		for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
		md = p;
		if ((md->phys_addr <= phys_addr) &&
		(phys_addr < (md->phys_addr +
		(md->num_pages << EFI_PAGE_SHIFT))))
		return md->attribute;
		}
		return 0;
		}

arch/x86/kernel/efi_64.c

0 → 100644

+164 −0

Original line number	Diff line number	Diff line
		/*
		* x86_64 specific EFI support functions
		* Based on Extensible Firmware Interface Specification version 1.0
		*
		* Copyright (C) 2005-2008 Intel Co.
		* Fenghua Yu <fenghua.yu@intel.com>
		* Bibo Mao <bibo.mao@intel.com>
		* Chandramouli Narayanan <mouli@linux.intel.com>
		* Huang Ying <ying.huang@intel.com>
		*
		* Code to convert EFI to E820 map has been implemented in elilo bootloader
		* based on a EFI patch by Edgar Hucek. Based on the E820 map, the page table
		* is setup appropriately for EFI runtime code.
		* - mouli 06/14/2007.
		*
		*/

		#include <linux/kernel.h>
		#include <linux/init.h>
		#include <linux/mm.h>
		#include <linux/types.h>
		#include <linux/spinlock.h>
		#include <linux/bootmem.h>
		#include <linux/ioport.h>
		#include <linux/module.h>
		#include <linux/efi.h>
		#include <linux/uaccess.h>
		#include <linux/io.h>
		#include <linux/reboot.h>

		#include <asm/setup.h>
		#include <asm/page.h>
		#include <asm/e820.h>
		#include <asm/pgtable.h>
		#include <asm/tlbflush.h>
		#include <asm/cacheflush.h>
		#include <asm/proto.h>
		#include <asm/efi.h>

		static pgd_t save_pgd __initdata;
		static unsigned long efi_flags __initdata;

		static int __init setup_noefi(char *arg)
		{
		efi_enabled = 0;
		return 0;
		}
		early_param("noefi", setup_noefi);

		static void __init early_mapping_set_exec(unsigned long start,
		unsigned long end,
		int executable)
		{
		pte_t *kpte;
		int level;

		while (start < end) {
		kpte = lookup_address((unsigned long)__va(start), &level);
		BUG_ON(!kpte);
		if (executable)
		set_pte(kpte, pte_mkexec(*kpte));
		else
		set_pte(kpte, __pte((pte_val(*kpte) \| _PAGE_NX) & \
		__supported_pte_mask));
		if (pte_huge(*kpte))
		start = (start + PMD_SIZE) & PMD_MASK;
		else
		start = (start + PAGE_SIZE) & PAGE_MASK;
		}
		}

		static void __init early_runtime_code_mapping_set_exec(int executable)
		{
		efi_memory_desc_t *md;
		void *p;

		/* Make EFI runtime service code area executable */
		for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
		md = p;
		if (md->type == EFI_RUNTIME_SERVICES_CODE) {
		unsigned long end;
		end = md->phys_addr + (md->num_pages << PAGE_SHIFT);
		early_mapping_set_exec(md->phys_addr, end, executable);
		}
		}
		}

		void __init efi_call_phys_prelog(void)
		{
		unsigned long vaddress;

		local_irq_save(efi_flags);
		early_runtime_code_mapping_set_exec(1);
		vaddress = (unsigned long)__va(0x0UL);
		pgd_val(save_pgd) = pgd_val(*pgd_offset_k(0x0UL));
		set_pgd(pgd_offset_k(0x0UL), *pgd_offset_k(vaddress));
		__flush_tlb_all();
		}

		void __init efi_call_phys_epilog(void)
		{
		/*
		* After the lock is released, the original page table is restored.
		*/
		set_pgd(pgd_offset_k(0x0UL), save_pgd);
		early_runtime_code_mapping_set_exec(0);
		__flush_tlb_all();
		local_irq_restore(efi_flags);
		}

		/*
		* We need to map the EFI memory map again after init_memory_mapping().
		*/
		void __init efi_map_memmap(void)
		{
		memmap.map = __va(memmap.phys_map);
		memmap.map_end = memmap.map + (memmap.nr_map * memmap.desc_size);
		}

		void __init efi_reserve_bootmem(void)
		{
		reserve_bootmem_generic((unsigned long)memmap.phys_map,
		memmap.nr_map * memmap.desc_size);
		}

		void __init runtime_code_page_mkexec(void)
		{
		efi_memory_desc_t *md;
		void *p;

		/* Make EFI runtime service code area executable */
		for (p = memmap.map; p < memmap.map_end; p += memmap.desc_size) {
		md = p;
		if (md->type == EFI_RUNTIME_SERVICES_CODE)
		change_page_attr_addr(md->virt_addr,
		md->num_pages,
		PAGE_KERNEL_EXEC);
		}
		__flush_tlb_all();
		}

		void __iomem * __init efi_ioremap(unsigned long offset,
		unsigned long size)
		{
		static unsigned pages_mapped;
		unsigned long last_addr;
		unsigned i, pages;

		last_addr = offset + size - 1;
		offset &= PAGE_MASK;
		pages = (PAGE_ALIGN(last_addr) - offset) >> PAGE_SHIFT;
		if (pages_mapped + pages > MAX_EFI_IO_PAGES)
		return NULL;

		for (i = 0; i < pages; i++) {
		set_fixmap_nocache(FIX_EFI_IO_MAP_FIRST_PAGE - pages_mapped,
		offset);
		offset += PAGE_SIZE;
		pages_mapped++;
		}

		return (void __iomem *)__fix_to_virt(FIX_EFI_IO_MAP_FIRST_PAGE - \
		(pages_mapped - pages));
		}

arch/x86/kernel/efi_stub_64.S

0 → 100644

+109 −0

Original line number	Diff line number	Diff line
		/*
		* Function calling ABI conversion from Linux to EFI for x86_64
		*
		* Copyright (C) 2007 Intel Corp
		* Bibo Mao <bibo.mao@intel.com>
		* Huang Ying <ying.huang@intel.com>
		*/

		#include <linux/linkage.h>

		#define SAVE_XMM \
		mov %rsp, %rax; \
		subq $0x70, %rsp; \
		and $~0xf, %rsp; \
		mov %rax, (%rsp); \
		mov %cr0, %rax; \
		clts; \
		mov %rax, 0x8(%rsp); \
		movaps %xmm0, 0x60(%rsp); \
		movaps %xmm1, 0x50(%rsp); \
		movaps %xmm2, 0x40(%rsp); \
		movaps %xmm3, 0x30(%rsp); \
		movaps %xmm4, 0x20(%rsp); \
		movaps %xmm5, 0x10(%rsp)

		#define RESTORE_XMM \
		movaps 0x60(%rsp), %xmm0; \
		movaps 0x50(%rsp), %xmm1; \
		movaps 0x40(%rsp), %xmm2; \
		movaps 0x30(%rsp), %xmm3; \
		movaps 0x20(%rsp), %xmm4; \
		movaps 0x10(%rsp), %xmm5; \
		mov 0x8(%rsp), %rsi; \
		mov %rsi, %cr0; \
		mov (%rsp), %rsp

		ENTRY(efi_call0)
		SAVE_XMM
		subq $32, %rsp
		call *%rdi
		addq $32, %rsp
		RESTORE_XMM
		ret

		ENTRY(efi_call1)
		SAVE_XMM
		subq $32, %rsp
		mov %rsi, %rcx
		call *%rdi
		addq $32, %rsp
		RESTORE_XMM
		ret

		ENTRY(efi_call2)
		SAVE_XMM
		subq $32, %rsp
		mov %rsi, %rcx
		call *%rdi
		addq $32, %rsp
		RESTORE_XMM
		ret

		ENTRY(efi_call3)
		SAVE_XMM
		subq $32, %rsp
		mov %rcx, %r8
		mov %rsi, %rcx
		call *%rdi
		addq $32, %rsp
		RESTORE_XMM
		ret

		ENTRY(efi_call4)
		SAVE_XMM
		subq $32, %rsp
		mov %r8, %r9
		mov %rcx, %r8
		mov %rsi, %rcx
		call *%rdi
		addq $32, %rsp
		RESTORE_XMM
		ret

		ENTRY(efi_call5)
		SAVE_XMM
		subq $48, %rsp
		mov %r9, 32(%rsp)
		mov %r8, %r9
		mov %rcx, %r8
		mov %rsi, %rcx
		call *%rdi
		addq $48, %rsp
		RESTORE_XMM
		ret

		ENTRY(efi_call6)
		SAVE_XMM
		mov (%rsp), %rax
		mov 8(%rax), %rax
		subq $48, %rsp
		mov %r9, 32(%rsp)
		mov %rax, 40(%rsp)
		mov %r8, %r9
		mov %rcx, %r8
		mov %rsi, %rcx
		call *%rdi
		addq $48, %rsp
		RESTORE_XMM
		ret