[people/ms/u-boot.git] / lib / efi_loader / efi_memory.c

/*
 *  EFI application memory management
 *
 *  Copyright (c) 2016 Alexander Graf
 *
 *  SPDX-License-Identifier:     GPL-2.0+
 */

#include <common.h>
#include <efi_loader.h>
#include <malloc.h>
#include <asm/global_data.h>
#include <libfdt_env.h>
#include <linux/list_sort.h>
#include <inttypes.h>
#include <watchdog.h>

DECLARE_GLOBAL_DATA_PTR;

struct efi_mem_list {
	struct list_head link;
	struct efi_mem_desc desc;
};

#define EFI_CARVE_NO_OVERLAP		-1
#define EFI_CARVE_LOOP_AGAIN		-2
#define EFI_CARVE_OVERLAPS_NONRAM	-3

/* This list contains all memory map items */
LIST_HEAD(efi_mem);

#ifdef CONFIG_EFI_LOADER_BOUNCE_BUFFER
void *efi_bounce_buffer;
#endif

/*
 * U-Boot services each EFI AllocatePool request as a separate
 * (multiple) page allocation.  We have to track the number of pages
 * to be able to free the correct amount later.
 * EFI requires 8 byte alignment for pool allocations, so we can
 * prepend each allocation with an 64 bit header tracking the
 * allocation size, and hand out the remainder to the caller.
 */
struct efi_pool_allocation {
	u64 num_pages;
	char data[];
};

/*
 * Sorts the memory list from highest address to lowest address
 *
 * When allocating memory we should always start from the highest
 * address chunk, so sort the memory list such that the first list
 * iterator gets the highest address and goes lower from there.
 */
static int efi_mem_cmp(void *priv, struct list_head *a, struct list_head *b)
{
	struct efi_mem_list *mema = list_entry(a, struct efi_mem_list, link);
	struct efi_mem_list *memb = list_entry(b, struct efi_mem_list, link);

	if (mema->desc.physical_start == memb->desc.physical_start)
		return 0;
	else if (mema->desc.physical_start < memb->desc.physical_start)
		return 1;
	else
		return -1;
}

static void efi_mem_sort(void)
{
	list_sort(NULL, &efi_mem, efi_mem_cmp);
}

/*
 * Unmaps all memory occupied by the carve_desc region from the
 * list entry pointed to by map.
 *
 * Returns EFI_CARVE_NO_OVERLAP if the regions don't overlap.
 * Returns EFI_CARVE_OVERLAPS_NONRAM if the carve and map overlap,
 *    and the map contains anything but free ram.
 *    (only when overlap_only_ram is true)
 * Returns EFI_CARVE_LOOP_AGAIN if the mapping list should be traversed
 *    again, as it has been altered
 * Returns the number of overlapping pages. The pages are removed from
 *     the mapping list.
 *
 * In case of EFI_CARVE_OVERLAPS_NONRAM it is the callers responsibility
 * to readd the already carved out pages to the mapping.
 */
static int efi_mem_carve_out(struct efi_mem_list *map,
			     struct efi_mem_desc *carve_desc,
			     bool overlap_only_ram)
{
	struct efi_mem_list *newmap;
	struct efi_mem_desc *map_desc = &map->desc;
	uint64_t map_start = map_desc->physical_start;
	uint64_t map_end = map_start + (map_desc->num_pages << EFI_PAGE_SHIFT);
	uint64_t carve_start = carve_desc->physical_start;
	uint64_t carve_end = carve_start +
			     (carve_desc->num_pages << EFI_PAGE_SHIFT);

	/* check whether we're overlapping */
	if ((carve_end <= map_start) || (carve_start >= map_end))
		return EFI_CARVE_NO_OVERLAP;

	/* We're overlapping with non-RAM, warn the caller if desired */
	if (overlap_only_ram && (map_desc->type != EFI_CONVENTIONAL_MEMORY))
		return EFI_CARVE_OVERLAPS_NONRAM;

	/* Sanitize carve_start and carve_end to lie within our bounds */
	carve_start = max(carve_start, map_start);
	carve_end = min(carve_end, map_end);

	/* Carving at the beginning of our map? Just move it! */
	if (carve_start == map_start) {
		if (map_end == carve_end) {
			/* Full overlap, just remove map */
			list_del(&map->link);
			free(map);
		} else {
			map->desc.physical_start = carve_end;
			map->desc.num_pages = (map_end - carve_end)
					      >> EFI_PAGE_SHIFT;
		}

		return (carve_end - carve_start) >> EFI_PAGE_SHIFT;
	}

	/*
	 * Overlapping maps, just split the list map at carve_start,
	 * it will get moved or removed in the next iteration.
	 *
	 * [ map_desc |__carve_start__| newmap ]
	 */

	/* Create a new map from [ carve_start ... map_end ] */
	newmap = calloc(1, sizeof(*newmap));
	newmap->desc = map->desc;
	newmap->desc.physical_start = carve_start;
	newmap->desc.num_pages = (map_end - carve_start) >> EFI_PAGE_SHIFT;
	/* Insert before current entry (descending address order) */
	list_add_tail(&newmap->link, &map->link);

	/* Shrink the map to [ map_start ... carve_start ] */
	map_desc->num_pages = (carve_start - map_start) >> EFI_PAGE_SHIFT;

	return EFI_CARVE_LOOP_AGAIN;
}

uint64_t efi_add_memory_map(uint64_t start, uint64_t pages, int memory_type,
			    bool overlap_only_ram)
{
	struct list_head *lhandle;
	struct efi_mem_list *newlist;
	bool carve_again;
	uint64_t carved_pages = 0;

	debug("%s: 0x%" PRIx64 " 0x%" PRIx64 " %d %s\n", __func__,
	      start, pages, memory_type, overlap_only_ram ? "yes" : "no");

	if (!pages)
		return start;

	newlist = calloc(1, sizeof(*newlist));
	newlist->desc.type = memory_type;
	newlist->desc.physical_start = start;
	newlist->desc.virtual_start = start;
	newlist->desc.num_pages = pages;

	switch (memory_type) {
	case EFI_RUNTIME_SERVICES_CODE:
	case EFI_RUNTIME_SERVICES_DATA:
		newlist->desc.attribute = (1 << EFI_MEMORY_WB_SHIFT) |
					  (1ULL << EFI_MEMORY_RUNTIME_SHIFT);
		break;
	case EFI_MMAP_IO:
		newlist->desc.attribute = 1ULL << EFI_MEMORY_RUNTIME_SHIFT;
		break;
	default:
		newlist->desc.attribute = 1 << EFI_MEMORY_WB_SHIFT;
		break;
	}

	/* Add our new map */
	do {
		carve_again = false;
		list_for_each(lhandle, &efi_mem) {
			struct efi_mem_list *lmem;
			int r;

			lmem = list_entry(lhandle, struct efi_mem_list, link);
			r = efi_mem_carve_out(lmem, &newlist->desc,
					      overlap_only_ram);
			switch (r) {
			case EFI_CARVE_OVERLAPS_NONRAM:
				/*
				 * The user requested to only have RAM overlaps,
				 * but we hit a non-RAM region. Error out.
				 */
				return 0;
			case EFI_CARVE_NO_OVERLAP:
				/* Just ignore this list entry */
				break;
			case EFI_CARVE_LOOP_AGAIN:
				/*
				 * We split an entry, but need to loop through
				 * the list again to actually carve it.
				 */
				carve_again = true;
				break;
			default:
				/* We carved a number of pages */
				carved_pages += r;
				carve_again = true;
				break;
			}

			if (carve_again) {
				/* The list changed, we need to start over */
				break;
			}
		}
	} while (carve_again);

	if (overlap_only_ram && (carved_pages != pages)) {
		/*
		 * The payload wanted to have RAM overlaps, but we overlapped
		 * with an unallocated region. Error out.
		 */
		return 0;
	}

	/* Add our new map */
        list_add_tail(&newlist->link, &efi_mem);

	/* And make sure memory is listed in descending order */
	efi_mem_sort();

	return start;
}

static uint64_t efi_find_free_memory(uint64_t len, uint64_t max_addr)
{
	struct list_head *lhandle;

	list_for_each(lhandle, &efi_mem) {
		struct efi_mem_list *lmem = list_entry(lhandle,
			struct efi_mem_list, link);
		struct efi_mem_desc *desc = &lmem->desc;
		uint64_t desc_len = desc->num_pages << EFI_PAGE_SHIFT;
		uint64_t desc_end = desc->physical_start + desc_len;
		uint64_t curmax = min(max_addr, desc_end);
		uint64_t ret = curmax - len;

		/* We only take memory from free RAM */
		if (desc->type != EFI_CONVENTIONAL_MEMORY)
			continue;

		/* Out of bounds for max_addr */
		if ((ret + len) > max_addr)
			continue;

		/* Out of bounds for upper map limit */
		if ((ret + len) > desc_end)
			continue;

		/* Out of bounds for lower map limit */
		if (ret < desc->physical_start)
			continue;

		/* Return the highest address in this map within bounds */
		return ret;
	}

	return 0;
}

efi_status_t efi_allocate_pages(int type, int memory_type,
				unsigned long pages, uint64_t *memory)
{
	u64 len = pages << EFI_PAGE_SHIFT;
	efi_status_t r = EFI_SUCCESS;
	uint64_t addr;

	switch (type) {
	case 0:
		/* Any page */
		addr = efi_find_free_memory(len, gd->start_addr_sp);
		if (!addr) {
			r = EFI_NOT_FOUND;
			break;
		}
		break;
	case 1:
		/* Max address */
		addr = efi_find_free_memory(len, *memory);
		if (!addr) {
			r = EFI_NOT_FOUND;
			break;
		}
		break;
	case 2:
		/* Exact address, reserve it. The addr is already in *memory. */
		addr = *memory;
		break;
	default:
		/* UEFI doesn't specify other allocation types */
		r = EFI_INVALID_PARAMETER;
		break;
	}

	if (r == EFI_SUCCESS) {
		uint64_t ret;

		/* Reserve that map in our memory maps */
		ret = efi_add_memory_map(addr, pages, memory_type, true);
		if (ret == addr) {
			*memory = addr;
		} else {
			/* Map would overlap, bail out */
			r = EFI_OUT_OF_RESOURCES;
		}
	}

	return r;
}

void *efi_alloc(uint64_t len, int memory_type)
{
	uint64_t ret = 0;
	uint64_t pages = (len + EFI_PAGE_MASK) >> EFI_PAGE_SHIFT;
	efi_status_t r;

	r = efi_allocate_pages(0, memory_type, pages, &ret);
	if (r == EFI_SUCCESS)
		return (void*)(uintptr_t)ret;

	return NULL;
}

efi_status_t efi_free_pages(uint64_t memory, unsigned long pages)
{
	uint64_t r = 0;

	r = efi_add_memory_map(memory, pages, EFI_CONVENTIONAL_MEMORY, false);
	/* Merging of adjacent free regions is missing */

	if (r == memory)
		return EFI_SUCCESS;

	return EFI_NOT_FOUND;
}

efi_status_t efi_allocate_pool(int pool_type, unsigned long size,
			       void **buffer)
{
	efi_status_t r;
	efi_physical_addr_t t;
	u64 num_pages = (size + sizeof(u64) + EFI_PAGE_MASK) >> EFI_PAGE_SHIFT;

	if (size == 0) {
		*buffer = NULL;
		return EFI_SUCCESS;
	}

	r = efi_allocate_pages(0, pool_type, num_pages, &t);

	if (r == EFI_SUCCESS) {
		struct efi_pool_allocation *alloc = (void *)(uintptr_t)t;
		alloc->num_pages = num_pages;
		*buffer = alloc->data;
	}

	return r;
}

efi_status_t efi_free_pool(void *buffer)
{
	efi_status_t r;
	struct efi_pool_allocation *alloc;

	if (buffer == NULL)
		return EFI_INVALID_PARAMETER;

	alloc = container_of(buffer, struct efi_pool_allocation, data);
	/* Sanity check, was the supplied address returned by allocate_pool */
	assert(((uintptr_t)alloc & EFI_PAGE_MASK) == 0);

	r = efi_free_pages((uintptr_t)alloc, alloc->num_pages);

	return r;
}

efi_status_t efi_get_memory_map(unsigned long *memory_map_size,
			       struct efi_mem_desc *memory_map,
			       unsigned long *map_key,
			       unsigned long *descriptor_size,
			       uint32_t *descriptor_version)
{
	ulong map_size = 0;
	int map_entries = 0;
	struct list_head *lhandle;
	unsigned long provided_map_size = *memory_map_size;

	list_for_each(lhandle, &efi_mem)
		map_entries++;

	map_size = map_entries * sizeof(struct efi_mem_desc);

	*memory_map_size = map_size;

	if (provided_map_size < map_size)
		return EFI_BUFFER_TOO_SMALL;

	if (descriptor_size)
		*descriptor_size = sizeof(struct efi_mem_desc);

	if (descriptor_version)
		*descriptor_version = EFI_MEMORY_DESCRIPTOR_VERSION;

	/* Copy list into array */
	if (memory_map) {
		/* Return the list in ascending order */
		memory_map = &memory_map[map_entries - 1];
		list_for_each(lhandle, &efi_mem) {
			struct efi_mem_list *lmem;

			lmem = list_entry(lhandle, struct efi_mem_list, link);
			*memory_map = lmem->desc;
			memory_map--;
		}
	}

	*map_key = 0;

	return EFI_SUCCESS;
}

__weak void efi_add_known_memory(void)
{
	int i;

	/* Add RAM */
	for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
		u64 ram_start = gd->bd->bi_dram[i].start;
		u64 ram_size = gd->bd->bi_dram[i].size;
		u64 start = (ram_start + EFI_PAGE_MASK) & ~EFI_PAGE_MASK;
		u64 pages = (ram_size + EFI_PAGE_MASK) >> EFI_PAGE_SHIFT;

		efi_add_memory_map(start, pages, EFI_CONVENTIONAL_MEMORY,
				   false);
	}
}

int efi_memory_init(void)
{
	unsigned long runtime_start, runtime_end, runtime_pages;
	unsigned long uboot_start, uboot_pages;
	unsigned long uboot_stack_size = 16 * 1024 * 1024;

	efi_add_known_memory();

	/* Add U-Boot */
	uboot_start = (gd->start_addr_sp - uboot_stack_size) & ~EFI_PAGE_MASK;
	uboot_pages = (gd->ram_top - uboot_start) >> EFI_PAGE_SHIFT;
	efi_add_memory_map(uboot_start, uboot_pages, EFI_LOADER_DATA, false);

	/* Add Runtime Services */
	runtime_start = (ulong)&__efi_runtime_start & ~EFI_PAGE_MASK;
	runtime_end = (ulong)&__efi_runtime_stop;
	runtime_end = (runtime_end + EFI_PAGE_MASK) & ~EFI_PAGE_MASK;
	runtime_pages = (runtime_end - runtime_start) >> EFI_PAGE_SHIFT;
	efi_add_memory_map(runtime_start, runtime_pages,
			   EFI_RUNTIME_SERVICES_CODE, false);

#ifdef CONFIG_EFI_LOADER_BOUNCE_BUFFER
	/* Request a 32bit 64MB bounce buffer region */
	uint64_t efi_bounce_buffer_addr = 0xffffffff;

	if (efi_allocate_pages(1, EFI_LOADER_DATA,
			       (64 * 1024 * 1024) >> EFI_PAGE_SHIFT,
			       &efi_bounce_buffer_addr) != EFI_SUCCESS)
		return -1;

	efi_bounce_buffer = (void*)(uintptr_t)efi_bounce_buffer_addr;
#endif

	return 0;
}
Commit	Line	Data
5d00995c AG	1	/*
	2	* EFI application memory management
	3	*
	4	* Copyright (c) 2016 Alexander Graf
	5	*
	6	* SPDX-License-Identifier: GPL-2.0+
	7	*/
	8
5d00995c AG	9	#include <common.h>
	10	#include <efi_loader.h>
	11	#include <malloc.h>
	12	#include <asm/global_data.h>
	13	#include <libfdt_env.h>
38ce65e1	14	#include <linux/list_sort.h>
5d00995c AG	15	#include <inttypes.h>
	16	#include <watchdog.h>
	17
	18	DECLARE_GLOBAL_DATA_PTR;
	19
	20	struct efi_mem_list {
	21	struct list_head link;
	22	struct efi_mem_desc desc;
	23	};
	24
74c16acc AG	25	#define EFI_CARVE_NO_OVERLAP -1
	26	#define EFI_CARVE_LOOP_AGAIN -2
	27	#define EFI_CARVE_OVERLAPS_NONRAM -3
	28
5d00995c AG	29	/* This list contains all memory map items */
	30	LIST_HEAD(efi_mem);
	31
51735ae0 AG	32	#ifdef CONFIG_EFI_LOADER_BOUNCE_BUFFER
	33	void *efi_bounce_buffer;
	34	#endif
	35
42417bc8 SB	36	/*
	37	* U-Boot services each EFI AllocatePool request as a separate
	38	* (multiple) page allocation. We have to track the number of pages
	39	* to be able to free the correct amount later.
	40	* EFI requires 8 byte alignment for pool allocations, so we can
	41	* prepend each allocation with an 64 bit header tracking the
	42	* allocation size, and hand out the remainder to the caller.
	43	*/
	44	struct efi_pool_allocation {
	45	u64 num_pages;
	46	char data[];
	47	};
	48
38ce65e1 AG	49	/*
	50	* Sorts the memory list from highest address to lowest address
	51	*
	52	* When allocating memory we should always start from the highest
	53	* address chunk, so sort the memory list such that the first list
	54	* iterator gets the highest address and goes lower from there.
	55	*/
	56	static int efi_mem_cmp(void priv, struct list_head a, struct list_head *b)
	57	{
	58	struct efi_mem_list *mema = list_entry(a, struct efi_mem_list, link);
	59	struct efi_mem_list *memb = list_entry(b, struct efi_mem_list, link);
	60
	61	if (mema->desc.physical_start == memb->desc.physical_start)
	62	return 0;
	63	else if (mema->desc.physical_start < memb->desc.physical_start)
	64	return 1;
	65	else
	66	return -1;
	67	}
	68
	69	static void efi_mem_sort(void)
	70	{
	71	list_sort(NULL, &efi_mem, efi_mem_cmp);
	72	}
	73
5d00995c AG	74	/*
	75	* Unmaps all memory occupied by the carve_desc region from the
	76	* list entry pointed to by map.
	77	*
852efbf5 SB	78	* Returns EFI_CARVE_NO_OVERLAP if the regions don't overlap.
	79	* Returns EFI_CARVE_OVERLAPS_NONRAM if the carve and map overlap,
	80	* and the map contains anything but free ram.
	81	* (only when overlap_only_ram is true)
	82	* Returns EFI_CARVE_LOOP_AGAIN if the mapping list should be traversed
	83	* again, as it has been altered
	84	* Returns the number of overlapping pages. The pages are removed from
	85	* the mapping list.
	86	*
	87	* In case of EFI_CARVE_OVERLAPS_NONRAM it is the callers responsibility
	88	* to readd the already carved out pages to the mapping.
5d00995c AG	89	*/
	90	static int efi_mem_carve_out(struct efi_mem_list *map,
	91	struct efi_mem_desc *carve_desc,
	92	bool overlap_only_ram)
	93	{
	94	struct efi_mem_list *newmap;
	95	struct efi_mem_desc *map_desc = &map->desc;
	96	uint64_t map_start = map_desc->physical_start;
	97	uint64_t map_end = map_start + (map_desc->num_pages << EFI_PAGE_SHIFT);
	98	uint64_t carve_start = carve_desc->physical_start;
	99	uint64_t carve_end = carve_start +
	100	(carve_desc->num_pages << EFI_PAGE_SHIFT);
	101
	102	/* check whether we're overlapping */
	103	if ((carve_end <= map_start) \|\| (carve_start >= map_end))
74c16acc	104	return EFI_CARVE_NO_OVERLAP;
5d00995c AG	105
	106	/* We're overlapping with non-RAM, warn the caller if desired */
	107	if (overlap_only_ram && (map_desc->type != EFI_CONVENTIONAL_MEMORY))
74c16acc	108	return EFI_CARVE_OVERLAPS_NONRAM;
5d00995c AG	109
	110	/* Sanitize carve_start and carve_end to lie within our bounds */
	111	carve_start = max(carve_start, map_start);
	112	carve_end = min(carve_end, map_end);
	113
	114	/* Carving at the beginning of our map? Just move it! */
	115	if (carve_start == map_start) {
	116	if (map_end == carve_end) {
	117	/* Full overlap, just remove map */
	118	list_del(&map->link);
511d0b97 SB	119	free(map);
	120	} else {
	121	map->desc.physical_start = carve_end;
	122	map->desc.num_pages = (map_end - carve_end)
	123	>> EFI_PAGE_SHIFT;
5d00995c AG	124	}
5d00995c AG	125
74c16acc	126	return (carve_end - carve_start) >> EFI_PAGE_SHIFT;
5d00995c AG	127	}
	128
	129	/*
	130	* Overlapping maps, just split the list map at carve_start,
	131	* it will get moved or removed in the next iteration.
	132	*
	133	* [ map_desc \|__carve_start__\| newmap ]
	134	*/
	135
	136	/* Create a new map from [ carve_start ... map_end ] */
	137	newmap = calloc(1, sizeof(*newmap));
	138	newmap->desc = map->desc;
	139	newmap->desc.physical_start = carve_start;
	140	newmap->desc.num_pages = (map_end - carve_start) >> EFI_PAGE_SHIFT;
b6a95172 SB	141	/* Insert before current entry (descending address order) */
b6a95172 SB	142	list_add_tail(&newmap->link, &map->link);
5d00995c AG	143
	144	/* Shrink the map to [ map_start ... carve_start ] */
	145	map_desc->num_pages = (carve_start - map_start) >> EFI_PAGE_SHIFT;
	146
74c16acc	147	return EFI_CARVE_LOOP_AGAIN;
5d00995c AG	148	}
	149
	150	uint64_t efi_add_memory_map(uint64_t start, uint64_t pages, int memory_type,
	151	bool overlap_only_ram)
	152	{
	153	struct list_head *lhandle;
	154	struct efi_mem_list *newlist;
74c16acc AG	155	bool carve_again;
74c16acc AG	156	uint64_t carved_pages = 0;
5d00995c	157
c933ed94 AF	158	debug("%s: 0x%" PRIx64 " 0x%" PRIx64 " %d %s\n", __func__,
	159	start, pages, memory_type, overlap_only_ram ? "yes" : "no");
	160
5d00995c AG	161	if (!pages)
	162	return start;
	163
	164	newlist = calloc(1, sizeof(*newlist));
	165	newlist->desc.type = memory_type;
	166	newlist->desc.physical_start = start;
	167	newlist->desc.virtual_start = start;
	168	newlist->desc.num_pages = pages;
	169
	170	switch (memory_type) {
	171	case EFI_RUNTIME_SERVICES_CODE:
	172	case EFI_RUNTIME_SERVICES_DATA:
	173	newlist->desc.attribute = (1 << EFI_MEMORY_WB_SHIFT) \|
	174	(1ULL << EFI_MEMORY_RUNTIME_SHIFT);
	175	break;
	176	case EFI_MMAP_IO:
	177	newlist->desc.attribute = 1ULL << EFI_MEMORY_RUNTIME_SHIFT;
	178	break;
	179	default:
	180	newlist->desc.attribute = 1 << EFI_MEMORY_WB_SHIFT;
	181	break;
	182	}
	183
	184	/* Add our new map */
	185	do {
74c16acc	186	carve_again = false;
5d00995c AG	187	list_for_each(lhandle, &efi_mem) {
	188	struct efi_mem_list *lmem;
	189	int r;
	190
	191	lmem = list_entry(lhandle, struct efi_mem_list, link);
	192	r = efi_mem_carve_out(lmem, &newlist->desc,
	193	overlap_only_ram);
74c16acc AG	194	switch (r) {
	195	case EFI_CARVE_OVERLAPS_NONRAM:
	196	/*
	197	* The user requested to only have RAM overlaps,
	198	* but we hit a non-RAM region. Error out.
	199	*/
5d00995c	200	return 0;
74c16acc AG	201	case EFI_CARVE_NO_OVERLAP:
	202	/* Just ignore this list entry */
	203	break;
	204	case EFI_CARVE_LOOP_AGAIN:
	205	/*
	206	* We split an entry, but need to loop through
	207	* the list again to actually carve it.
	208	*/
	209	carve_again = true;
	210	break;
	211	default:
	212	/* We carved a number of pages */
	213	carved_pages += r;
	214	carve_again = true;
	215	break;
	216	}
	217
	218	if (carve_again) {
	219	/* The list changed, we need to start over */
5d00995c AG	220	break;
	221	}
	222	}
74c16acc AG	223	} while (carve_again);
	224
	225	if (overlap_only_ram && (carved_pages != pages)) {
	226	/*
	227	* The payload wanted to have RAM overlaps, but we overlapped
	228	* with an unallocated region. Error out.
	229	*/
	230	return 0;
	231	}
5d00995c AG	232
	233	/* Add our new map */
	234	list_add_tail(&newlist->link, &efi_mem);
	235
38ce65e1 AG	236	/* And make sure memory is listed in descending order */
	237	efi_mem_sort();
	238
5d00995c AG	239	return start;
	240	}
	241
	242	static uint64_t efi_find_free_memory(uint64_t len, uint64_t max_addr)
	243	{
	244	struct list_head *lhandle;
	245
	246	list_for_each(lhandle, &efi_mem) {
	247	struct efi_mem_list *lmem = list_entry(lhandle,
	248	struct efi_mem_list, link);
	249	struct efi_mem_desc *desc = &lmem->desc;
	250	uint64_t desc_len = desc->num_pages << EFI_PAGE_SHIFT;
	251	uint64_t desc_end = desc->physical_start + desc_len;
	252	uint64_t curmax = min(max_addr, desc_end);
	253	uint64_t ret = curmax - len;
	254
	255	/* We only take memory from free RAM */
	256	if (desc->type != EFI_CONVENTIONAL_MEMORY)
	257	continue;
	258
	259	/* Out of bounds for max_addr */
	260	if ((ret + len) > max_addr)
	261	continue;
	262
	263	/* Out of bounds for upper map limit */
	264	if ((ret + len) > desc_end)
	265	continue;
	266
	267	/* Out of bounds for lower map limit */
	268	if (ret < desc->physical_start)
	269	continue;
	270
	271	/* Return the highest address in this map within bounds */
	272	return ret;
	273	}
	274
	275	return 0;
	276	}
	277
	278	efi_status_t efi_allocate_pages(int type, int memory_type,
	279	unsigned long pages, uint64_t *memory)
	280	{
	281	u64 len = pages << EFI_PAGE_SHIFT;
	282	efi_status_t r = EFI_SUCCESS;
	283	uint64_t addr;
	284
	285	switch (type) {
	286	case 0:
	287	/* Any page */
dede284d	288	addr = efi_find_free_memory(len, gd->start_addr_sp);
5d00995c AG	289	if (!addr) {
	290	r = EFI_NOT_FOUND;
	291	break;
	292	}
	293	break;
	294	case 1:
	295	/* Max address */
	296	addr = efi_find_free_memory(len, *memory);
	297	if (!addr) {
	298	r = EFI_NOT_FOUND;
	299	break;
	300	}
	301	break;
	302	case 2:
	303	/* Exact address, reserve it. The addr is already in memory. /
	304	addr = *memory;
	305	break;
	306	default:
	307	/* UEFI doesn't specify other allocation types */
	308	r = EFI_INVALID_PARAMETER;
	309	break;
	310	}
	311
	312	if (r == EFI_SUCCESS) {
	313	uint64_t ret;
	314
	315	/* Reserve that map in our memory maps */
	316	ret = efi_add_memory_map(addr, pages, memory_type, true);
	317	if (ret == addr) {
	318	*memory = addr;
	319	} else {
	320	/* Map would overlap, bail out */
	321	r = EFI_OUT_OF_RESOURCES;
	322	}
	323	}
	324
	325	return r;
	326	}
	327
	328	void *efi_alloc(uint64_t len, int memory_type)
	329	{
	330	uint64_t ret = 0;
	331	uint64_t pages = (len + EFI_PAGE_MASK) >> EFI_PAGE_SHIFT;
	332	efi_status_t r;
	333
	334	r = efi_allocate_pages(0, memory_type, pages, &ret);
	335	if (r == EFI_SUCCESS)
	336	return (void*)(uintptr_t)ret;
	337
	338	return NULL;
	339	}
	340
	341	efi_status_t efi_free_pages(uint64_t memory, unsigned long pages)
	342	{
b61d857b SB	343	uint64_t r = 0;
	344
	345	r = efi_add_memory_map(memory, pages, EFI_CONVENTIONAL_MEMORY, false);
	346	/* Merging of adjacent free regions is missing */
	347
	348	if (r == memory)
	349	return EFI_SUCCESS;
	350
	351	return EFI_NOT_FOUND;
5d00995c AG	352	}
5d00995c AG	353
ead1274b SB	354	efi_status_t efi_allocate_pool(int pool_type, unsigned long size,
	355	void **buffer)
	356	{
	357	efi_status_t r;
	358	efi_physical_addr_t t;
42417bc8 SB	359	u64 num_pages = (size + sizeof(u64) + EFI_PAGE_MASK) >> EFI_PAGE_SHIFT;
	360
	361	if (size == 0) {
	362	*buffer = NULL;
	363	return EFI_SUCCESS;
	364	}
ead1274b SB	365
ead1274b SB	366	r = efi_allocate_pages(0, pool_type, num_pages, &t);
42417bc8 SB	367
	368	if (r == EFI_SUCCESS) {
	369	struct efi_pool_allocation alloc = (void )(uintptr_t)t;
	370	alloc->num_pages = num_pages;
	371	*buffer = alloc->data;
	372	}
	373
	374	return r;
	375	}
	376
	377	efi_status_t efi_free_pool(void *buffer)
	378	{
	379	efi_status_t r;
	380	struct efi_pool_allocation *alloc;
	381
71275a3e	382	if (buffer == NULL)
	383	return EFI_INVALID_PARAMETER;
	384
42417bc8 SB	385	alloc = container_of(buffer, struct efi_pool_allocation, data);
	386	/* Sanity check, was the supplied address returned by allocate_pool */
	387	assert(((uintptr_t)alloc & EFI_PAGE_MASK) == 0);
	388
	389	r = efi_free_pages((uintptr_t)alloc, alloc->num_pages);
ead1274b SB	390
	391	return r;
	392	}
	393
5d00995c AG	394	efi_status_t efi_get_memory_map(unsigned long *memory_map_size,
	395	struct efi_mem_desc *memory_map,
	396	unsigned long *map_key,
	397	unsigned long *descriptor_size,
	398	uint32_t *descriptor_version)
	399	{
	400	ulong map_size = 0;
cee752fa	401	int map_entries = 0;
5d00995c	402	struct list_head *lhandle;
bdf5c1b3	403	unsigned long provided_map_size = *memory_map_size;
5d00995c AG	404
5d00995c AG	405	list_for_each(lhandle, &efi_mem)
cee752fa AG	406	map_entries++;
	407
	408	map_size = map_entries * sizeof(struct efi_mem_desc);
5d00995c	409
a1b24823 RC	410	*memory_map_size = map_size;
a1b24823 RC	411
0ecba5db	412	if (provided_map_size < map_size)
	413	return EFI_BUFFER_TOO_SMALL;
	414
5d00995c AG	415	if (descriptor_size)
	416	*descriptor_size = sizeof(struct efi_mem_desc);
	417
4c02c11d MYK	418	if (descriptor_version)
	419	*descriptor_version = EFI_MEMORY_DESCRIPTOR_VERSION;
	420
5d00995c AG	421	/* Copy list into array */
5d00995c AG	422	if (memory_map) {
cee752fa AG	423	/* Return the list in ascending order */
cee752fa AG	424	memory_map = &memory_map[map_entries - 1];
5d00995c AG	425	list_for_each(lhandle, &efi_mem) {
	426	struct efi_mem_list *lmem;
	427
	428	lmem = list_entry(lhandle, struct efi_mem_list, link);
	429	*memory_map = lmem->desc;
cee752fa	430	memory_map--;
5d00995c AG	431	}
	432	}
	433
c6e3c3e6	434	*map_key = 0;
c6e3c3e6	435
5d00995c AG	436	return EFI_SUCCESS;
	437	}
	438
42633745	439	__weak void efi_add_known_memory(void)
5d00995c	440	{
5d00995c AG	441	int i;
	442
	443	/* Add RAM */
	444	for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
	445	u64 ram_start = gd->bd->bi_dram[i].start;
	446	u64 ram_size = gd->bd->bi_dram[i].size;
	447	u64 start = (ram_start + EFI_PAGE_MASK) & ~EFI_PAGE_MASK;
	448	u64 pages = (ram_size + EFI_PAGE_MASK) >> EFI_PAGE_SHIFT;
	449
	450	efi_add_memory_map(start, pages, EFI_CONVENTIONAL_MEMORY,
	451	false);
	452	}
42633745 YS	453	}
	454
	455	int efi_memory_init(void)
	456	{
	457	unsigned long runtime_start, runtime_end, runtime_pages;
	458	unsigned long uboot_start, uboot_pages;
	459	unsigned long uboot_stack_size = 16 * 1024 * 1024;
	460
	461	efi_add_known_memory();
5d00995c AG	462
	463	/* Add U-Boot */
	464	uboot_start = (gd->start_addr_sp - uboot_stack_size) & ~EFI_PAGE_MASK;
	465	uboot_pages = (gd->ram_top - uboot_start) >> EFI_PAGE_SHIFT;
	466	efi_add_memory_map(uboot_start, uboot_pages, EFI_LOADER_DATA, false);
	467
	468	/* Add Runtime Services */
	469	runtime_start = (ulong)&__efi_runtime_start & ~EFI_PAGE_MASK;
	470	runtime_end = (ulong)&__efi_runtime_stop;
	471	runtime_end = (runtime_end + EFI_PAGE_MASK) & ~EFI_PAGE_MASK;
	472	runtime_pages = (runtime_end - runtime_start) >> EFI_PAGE_SHIFT;
	473	efi_add_memory_map(runtime_start, runtime_pages,
	474	EFI_RUNTIME_SERVICES_CODE, false);
	475
51735ae0 AG	476	#ifdef CONFIG_EFI_LOADER_BOUNCE_BUFFER
	477	/* Request a 32bit 64MB bounce buffer region */
	478	uint64_t efi_bounce_buffer_addr = 0xffffffff;
	479
	480	if (efi_allocate_pages(1, EFI_LOADER_DATA,
	481	(64 * 1024 * 1024) >> EFI_PAGE_SHIFT,
	482	&efi_bounce_buffer_addr) != EFI_SUCCESS)
	483	return -1;
	484
	485	efi_bounce_buffer = (void*)(uintptr_t)efi_bounce_buffer_addr;
	486	#endif
	487
5d00995c AG	488	return 0;
5d00995c AG	489	}