efi-stub-helper.c 10.6 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * Helper functions used by the EFI stub on multiple
 * architectures. This should be #included by the EFI stub
 * implementation files.
 *
 * Copyright 2011 Intel Corporation; author Matt Fleming
 *
 * This file is part of the Linux kernel, and is made available
 * under the terms of the GNU General Public License version 2.
 *
 */
#define EFI_READ_CHUNK_SIZE	(1024 * 1024)

struct initrd {
	efi_file_handle_t *handle;
	u64 size;
};




22 23
static void efi_char16_printk(efi_system_table_t *sys_table_arg,
			      efi_char16_t *str)
24 25 26
{
	struct efi_simple_text_output_protocol *out;

27
	out = (struct efi_simple_text_output_protocol *)sys_table_arg->con_out;
28 29 30
	efi_call_phys2(out->output_string, out, str);
}

31
static void efi_printk(efi_system_table_t *sys_table_arg, char *str)
32 33 34 35 36 37 38 39 40
{
	char *s8;

	for (s8 = str; *s8; s8++) {
		efi_char16_t ch[2] = { 0 };

		ch[0] = *s8;
		if (*s8 == '\n') {
			efi_char16_t nl[2] = { '\r', 0 };
41
			efi_char16_printk(sys_table_arg, nl);
42 43
		}

44
		efi_char16_printk(sys_table_arg, ch);
45 46 47 48
	}
}


49 50 51
static efi_status_t __get_map(efi_system_table_t *sys_table_arg,
			      efi_memory_desc_t **map,
			      unsigned long *map_size,
52 53 54 55 56 57 58 59 60 61 62 63 64 65
			      unsigned long *desc_size)
{
	efi_memory_desc_t *m = NULL;
	efi_status_t status;
	unsigned long key;
	u32 desc_version;

	*map_size = sizeof(*m) * 32;
again:
	/*
	 * Add an additional efi_memory_desc_t because we're doing an
	 * allocation which may be in a new descriptor region.
	 */
	*map_size += sizeof(*m);
66
	status = efi_call_phys3(sys_table_arg->boottime->allocate_pool,
67 68 69 70
				EFI_LOADER_DATA, *map_size, (void **)&m);
	if (status != EFI_SUCCESS)
		goto fail;

71 72
	status = efi_call_phys5(sys_table_arg->boottime->get_memory_map,
				map_size, m, &key, desc_size, &desc_version);
73
	if (status == EFI_BUFFER_TOO_SMALL) {
74
		efi_call_phys1(sys_table_arg->boottime->free_pool, m);
75 76 77 78
		goto again;
	}

	if (status != EFI_SUCCESS)
79
		efi_call_phys1(sys_table_arg->boottime->free_pool, m);
80 81 82 83 84 85 86 87 88

fail:
	*map = m;
	return status;
}

/*
 * Allocate at the highest possible address that is not above 'max'.
 */
89
static efi_status_t efi_high_alloc(efi_system_table_t *sys_table_arg,
90 91
			       unsigned long size, unsigned long align,
			       unsigned long *addr, unsigned long max)
92 93 94 95 96 97 98 99
{
	unsigned long map_size, desc_size;
	efi_memory_desc_t *map;
	efi_status_t status;
	unsigned long nr_pages;
	u64 max_addr = 0;
	int i;

100
	status = __get_map(sys_table_arg, &map, &map_size, &desc_size);
101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
	if (status != EFI_SUCCESS)
		goto fail;

	nr_pages = round_up(size, EFI_PAGE_SIZE) / EFI_PAGE_SIZE;
again:
	for (i = 0; i < map_size / desc_size; i++) {
		efi_memory_desc_t *desc;
		unsigned long m = (unsigned long)map;
		u64 start, end;

		desc = (efi_memory_desc_t *)(m + (i * desc_size));
		if (desc->type != EFI_CONVENTIONAL_MEMORY)
			continue;

		if (desc->num_pages < nr_pages)
			continue;

		start = desc->phys_addr;
		end = start + desc->num_pages * (1UL << EFI_PAGE_SHIFT);

		if ((start + size) > end || (start + size) > max)
			continue;

		if (end - size > max)
			end = max;

		if (round_down(end - size, align) < start)
			continue;

		start = round_down(end - size, align);

		/*
		 * Don't allocate at 0x0. It will confuse code that
		 * checks pointers against NULL.
		 */
		if (start == 0x0)
			continue;

		if (start > max_addr)
			max_addr = start;
	}

	if (!max_addr)
		status = EFI_NOT_FOUND;
	else {
146
		status = efi_call_phys4(sys_table_arg->boottime->allocate_pages,
147 148 149 150 151 152 153 154 155 156 157 158
					EFI_ALLOCATE_ADDRESS, EFI_LOADER_DATA,
					nr_pages, &max_addr);
		if (status != EFI_SUCCESS) {
			max = max_addr;
			max_addr = 0;
			goto again;
		}

		*addr = max_addr;
	}

free_pool:
159
	efi_call_phys1(sys_table_arg->boottime->free_pool, map);
160 161 162 163 164 165 166 167

fail:
	return status;
}

/*
 * Allocate at the lowest possible address.
 */
168 169
static efi_status_t efi_low_alloc(efi_system_table_t *sys_table_arg,
			      unsigned long size, unsigned long align,
170 171 172 173 174 175 176 177
			      unsigned long *addr)
{
	unsigned long map_size, desc_size;
	efi_memory_desc_t *map;
	efi_status_t status;
	unsigned long nr_pages;
	int i;

178
	status = __get_map(sys_table_arg, &map, &map_size, &desc_size);
179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210
	if (status != EFI_SUCCESS)
		goto fail;

	nr_pages = round_up(size, EFI_PAGE_SIZE) / EFI_PAGE_SIZE;
	for (i = 0; i < map_size / desc_size; i++) {
		efi_memory_desc_t *desc;
		unsigned long m = (unsigned long)map;
		u64 start, end;

		desc = (efi_memory_desc_t *)(m + (i * desc_size));

		if (desc->type != EFI_CONVENTIONAL_MEMORY)
			continue;

		if (desc->num_pages < nr_pages)
			continue;

		start = desc->phys_addr;
		end = start + desc->num_pages * (1UL << EFI_PAGE_SHIFT);

		/*
		 * Don't allocate at 0x0. It will confuse code that
		 * checks pointers against NULL. Skip the first 8
		 * bytes so we start at a nice even number.
		 */
		if (start == 0x0)
			start += 8;

		start = round_up(start, align);
		if ((start + size) > end)
			continue;

211
		status = efi_call_phys4(sys_table_arg->boottime->allocate_pages,
212 213 214 215 216 217 218 219 220 221 222 223
					EFI_ALLOCATE_ADDRESS, EFI_LOADER_DATA,
					nr_pages, &start);
		if (status == EFI_SUCCESS) {
			*addr = start;
			break;
		}
	}

	if (i == map_size / desc_size)
		status = EFI_NOT_FOUND;

free_pool:
224
	efi_call_phys1(sys_table_arg->boottime->free_pool, map);
225 226 227 228
fail:
	return status;
}

229
static void efi_free(efi_system_table_t *sys_table_arg, unsigned long size,
230
		     unsigned long addr)
231 232 233 234
{
	unsigned long nr_pages;

	nr_pages = round_up(size, EFI_PAGE_SIZE) / EFI_PAGE_SIZE;
235
	efi_call_phys2(sys_table_arg->boottime->free_pages, addr, nr_pages);
236 237 238 239 240 241 242 243 244
}


/*
 * Check the cmdline for a LILO-style initrd= arguments.
 *
 * We only support loading an initrd from the same filesystem as the
 * kernel image.
 */
245 246
static efi_status_t handle_ramdisks(efi_system_table_t *sys_table_arg,
				    efi_loaded_image_t *image,
247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287
				    struct setup_header *hdr)
{
	struct initrd *initrds;
	unsigned long initrd_addr;
	efi_guid_t fs_proto = EFI_FILE_SYSTEM_GUID;
	u64 initrd_total;
	efi_file_io_interface_t *io;
	efi_file_handle_t *fh;
	efi_status_t status;
	int nr_initrds;
	char *str;
	int i, j, k;

	initrd_addr = 0;
	initrd_total = 0;

	str = (char *)(unsigned long)hdr->cmd_line_ptr;

	j = 0;			/* See close_handles */

	if (!str || !*str)
		return EFI_SUCCESS;

	for (nr_initrds = 0; *str; nr_initrds++) {
		str = strstr(str, "initrd=");
		if (!str)
			break;

		str += 7;

		/* Skip any leading slashes */
		while (*str == '/' || *str == '\\')
			str++;

		while (*str && *str != ' ' && *str != '\n')
			str++;
	}

	if (!nr_initrds)
		return EFI_SUCCESS;

288
	status = efi_call_phys3(sys_table_arg->boottime->allocate_pool,
289 290 291 292
				EFI_LOADER_DATA,
				nr_initrds * sizeof(*initrds),
				&initrds);
	if (status != EFI_SUCCESS) {
293
		efi_printk(sys_table_arg, "Failed to alloc mem for initrds\n");
294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338
		goto fail;
	}

	str = (char *)(unsigned long)hdr->cmd_line_ptr;
	for (i = 0; i < nr_initrds; i++) {
		struct initrd *initrd;
		efi_file_handle_t *h;
		efi_file_info_t *info;
		efi_char16_t filename_16[256];
		unsigned long info_sz;
		efi_guid_t info_guid = EFI_FILE_INFO_ID;
		efi_char16_t *p;
		u64 file_sz;

		str = strstr(str, "initrd=");
		if (!str)
			break;

		str += 7;

		initrd = &initrds[i];
		p = filename_16;

		/* Skip any leading slashes */
		while (*str == '/' || *str == '\\')
			str++;

		while (*str && *str != ' ' && *str != '\n') {
			if ((u8 *)p >= (u8 *)filename_16 + sizeof(filename_16))
				break;

			if (*str == '/') {
				*p++ = '\\';
				*str++;
			} else {
				*p++ = *str++;
			}
		}

		*p = '\0';

		/* Only open the volume once. */
		if (!i) {
			efi_boot_services_t *boottime;

339
			boottime = sys_table_arg->boottime;
340 341 342 343

			status = efi_call_phys3(boottime->handle_protocol,
					image->device_handle, &fs_proto, &io);
			if (status != EFI_SUCCESS) {
344
				efi_printk(sys_table_arg, "Failed to handle fs_proto\n");
345 346 347 348 349
				goto free_initrds;
			}

			status = efi_call_phys2(io->open_volume, io, &fh);
			if (status != EFI_SUCCESS) {
350
				efi_printk(sys_table_arg, "Failed to open volume\n");
351 352 353 354 355 356 357
				goto free_initrds;
			}
		}

		status = efi_call_phys5(fh->open, fh, &h, filename_16,
					EFI_FILE_MODE_READ, (u64)0);
		if (status != EFI_SUCCESS) {
358 359 360
			efi_printk(sys_table_arg, "Failed to open initrd file: ");
			efi_char16_printk(sys_table_arg, filename_16);
			efi_printk(sys_table_arg, "\n");
361 362 363 364 365 366 367 368 369
			goto close_handles;
		}

		initrd->handle = h;

		info_sz = 0;
		status = efi_call_phys4(h->get_info, h, &info_guid,
					&info_sz, NULL);
		if (status != EFI_BUFFER_TOO_SMALL) {
370
			efi_printk(sys_table_arg, "Failed to get initrd info size\n");
371 372 373 374
			goto close_handles;
		}

grow:
375
		status = efi_call_phys3(sys_table_arg->boottime->allocate_pool,
376 377
					EFI_LOADER_DATA, info_sz, &info);
		if (status != EFI_SUCCESS) {
378
			efi_printk(sys_table_arg, "Failed to alloc mem for initrd info\n");
379 380 381 382 383 384
			goto close_handles;
		}

		status = efi_call_phys4(h->get_info, h, &info_guid,
					&info_sz, info);
		if (status == EFI_BUFFER_TOO_SMALL) {
385 386
			efi_call_phys1(sys_table_arg->boottime->free_pool,
				       info);
387 388 389 390
			goto grow;
		}

		file_sz = info->file_size;
391
		efi_call_phys1(sys_table_arg->boottime->free_pool, info);
392 393

		if (status != EFI_SUCCESS) {
394
			efi_printk(sys_table_arg, "Failed to get initrd info\n");
395 396 397 398 399 400 401 402 403 404 405 406 407 408 409
			goto close_handles;
		}

		initrd->size = file_sz;
		initrd_total += file_sz;
	}

	if (initrd_total) {
		unsigned long addr;

		/*
		 * Multiple initrd's need to be at consecutive
		 * addresses in memory, so allocate enough memory for
		 * all the initrd's.
		 */
410 411
		status = efi_high_alloc(sys_table_arg, initrd_total, 0x1000,
				    &initrd_addr, hdr->initrd_addr_max);
412
		if (status != EFI_SUCCESS) {
413
			efi_printk(sys_table_arg, "Failed to alloc highmem for initrds\n");
414 415 416 417 418
			goto close_handles;
		}

		/* We've run out of free low memory. */
		if (initrd_addr > hdr->initrd_addr_max) {
419
			efi_printk(sys_table_arg, "We've run out of free low memory\n");
420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438
			status = EFI_INVALID_PARAMETER;
			goto free_initrd_total;
		}

		addr = initrd_addr;
		for (j = 0; j < nr_initrds; j++) {
			u64 size;

			size = initrds[j].size;
			while (size) {
				u64 chunksize;
				if (size > EFI_READ_CHUNK_SIZE)
					chunksize = EFI_READ_CHUNK_SIZE;
				else
					chunksize = size;
				status = efi_call_phys3(fh->read,
							initrds[j].handle,
							&chunksize, addr);
				if (status != EFI_SUCCESS) {
439
					efi_printk(sys_table_arg, "Failed to read initrd\n");
440 441 442 443 444 445 446 447 448 449 450
					goto free_initrd_total;
				}
				addr += chunksize;
				size -= chunksize;
			}

			efi_call_phys1(fh->close, initrds[j].handle);
		}

	}

451
	efi_call_phys1(sys_table_arg->boottime->free_pool, initrds);
452 453 454 455 456 457 458

	hdr->ramdisk_image = initrd_addr;
	hdr->ramdisk_size = initrd_total;

	return status;

free_initrd_total:
459
	efi_free(sys_table_arg, initrd_total, initrd_addr);
460 461 462 463 464

close_handles:
	for (k = j; k < i; k++)
		efi_call_phys1(fh->close, initrds[k].handle);
free_initrds:
465
	efi_call_phys1(sys_table_arg->boottime->free_pool, initrds);
466 467 468 469 470 471
fail:
	hdr->ramdisk_image = 0;
	hdr->ramdisk_size = 0;

	return status;
}