eboot.c 22.9 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0-only
2

M
Matt Fleming 已提交
3 4 5 6 7 8 9
/* -----------------------------------------------------------------------
 *
 *   Copyright 2011 Intel Corporation; author Matt Fleming
 *
 * ----------------------------------------------------------------------- */

#include <linux/efi.h>
10
#include <linux/pci.h>
11

M
Matt Fleming 已提交
12
#include <asm/efi.h>
13
#include <asm/e820/types.h>
M
Matt Fleming 已提交
14 15
#include <asm/setup.h>
#include <asm/desc.h>
16
#include <asm/boot.h>
M
Matt Fleming 已提交
17

18
#include "../string.h"
M
Matt Fleming 已提交
19 20 21 22
#include "eboot.h"

static efi_system_table_t *sys_table;

23 24
static struct efi_config *efi_early;

A
Ard Biesheuvel 已提交
25 26 27 28
__pure const struct efi_config *__efi_early(void)
{
	return efi_early;
}
29

30 31 32 33 34 35 36
#define BOOT_SERVICES(bits)						\
static void setup_boot_services##bits(struct efi_config *c)		\
{									\
	efi_system_table_##bits##_t *table;				\
									\
	table = (typeof(table))sys_table;				\
									\
I
Ingo Molnar 已提交
37 38 39
	c->runtime_services	= table->runtime;			\
	c->boot_services	= table->boottime;			\
	c->text_output		= table->con_out;			\
40 41 42
}
BOOT_SERVICES(32);
BOOT_SERVICES(64);
M
Matt Fleming 已提交
43

44
void efi_char16_printk(efi_system_table_t *table, efi_char16_t *str)
45
{
46
	efi_call_proto(efi_simple_text_output_protocol, output_string,
47 48
		       ((efi_simple_text_output_protocol_t *)(unsigned long)
				efi_early->text_output), str);
49 50
}

51
static efi_status_t
52
preserve_pci_rom_image(efi_pci_io_protocol_t *pci, struct pci_setup_rom **__rom)
53
{
54
	struct pci_setup_rom *rom = NULL;
55
	efi_status_t status;
56
	unsigned long size;
57
	uint64_t romsize;
58
	void *romimage;
59

60
	/*
61 62
	 * Some firmware images contain EFI function pointers at the place where
	 * the romimage and romsize fields are supposed to be. Typically the EFI
63 64 65 66
	 * code is mapped at high addresses, translating to an unrealistically
	 * large romsize. The UEFI spec limits the size of option ROMs to 16
	 * MiB so we reject any ROMs over 16 MiB in size to catch this.
	 */
67
	romimage = efi_table_attr(efi_pci_io_protocol, romimage, pci);
68
	romsize = efi_table_attr(efi_pci_io_protocol, romsize, pci);
69
	if (!romimage || !romsize || romsize > SZ_16M)
70
		return EFI_INVALID_PARAMETER;
71

72
	size = romsize + sizeof(*rom);
73

74 75
	status = efi_call_early(allocate_pool, EFI_LOADER_DATA, size,
				(void **)&rom);
76
	if (status != EFI_SUCCESS) {
I
Ingo Molnar 已提交
77
		efi_printk(sys_table, "Failed to allocate memory for 'rom'\n");
78
		return status;
79
	}
80

81 82
	memset(rom, 0, sizeof(*rom));

I
Ingo Molnar 已提交
83 84 85 86
	rom->data.type	= SETUP_PCI;
	rom->data.len	= size - sizeof(struct setup_data);
	rom->data.next	= 0;
	rom->pcilen	= pci->romsize;
87 88
	*__rom = rom;

89 90 91
	status = efi_call_proto(efi_pci_io_protocol, pci.read, pci,
				EfiPciIoWidthUint16, PCI_VENDOR_ID, 1,
				&rom->vendor);
92

93 94
	if (status != EFI_SUCCESS) {
		efi_printk(sys_table, "Failed to read rom->vendor\n");
95
		goto free_struct;
96
	}
97

98 99 100
	status = efi_call_proto(efi_pci_io_protocol, pci.read, pci,
				EfiPciIoWidthUint16, PCI_DEVICE_ID, 1,
				&rom->devid);
101

102 103
	if (status != EFI_SUCCESS) {
		efi_printk(sys_table, "Failed to read rom->devid\n");
104
		goto free_struct;
105
	}
106

107 108 109
	status = efi_call_proto(efi_pci_io_protocol, get_location, pci,
				&rom->segment, &rom->bus, &rom->device,
				&rom->function);
110 111 112 113

	if (status != EFI_SUCCESS)
		goto free_struct;

114
	memcpy(rom->romdata, romimage, romsize);
115 116 117
	return status;

free_struct:
118
	efi_call_early(free_pool, rom);
119 120 121
	return status;
}

122 123 124 125 126 127 128 129 130 131
/*
 * There's no way to return an informative status from this function,
 * because any analysis (and printing of error messages) needs to be
 * done directly at the EFI function call-site.
 *
 * For example, EFI_INVALID_PARAMETER could indicate a bug or maybe we
 * just didn't find any PCI devices, but there's no way to tell outside
 * the context of the call.
 */
static void setup_efi_pci(struct boot_params *params)
M
Matt Fleming 已提交
132 133
{
	efi_status_t status;
134 135 136
	void **pci_handle = NULL;
	efi_guid_t pci_proto = EFI_PCI_IO_PROTOCOL_GUID;
	unsigned long size = 0;
137 138
	unsigned long nr_pci;
	struct setup_data *data;
139
	efi_handle_t h;
140
	int i;
M
Matt Fleming 已提交
141

142 143 144
	status = efi_call_early(locate_handle,
				EFI_LOCATE_BY_PROTOCOL,
				&pci_proto, NULL, &size, pci_handle);
M
Matt Fleming 已提交
145

146
	if (status == EFI_BUFFER_TOO_SMALL) {
147 148 149
		status = efi_call_early(allocate_pool,
					EFI_LOADER_DATA,
					size, (void **)&pci_handle);
M
Matt Fleming 已提交
150

151
		if (status != EFI_SUCCESS) {
I
Ingo Molnar 已提交
152
			efi_printk(sys_table, "Failed to allocate memory for 'pci_handle'\n");
153
			return;
154
		}
M
Matt Fleming 已提交
155

156 157 158
		status = efi_call_early(locate_handle,
					EFI_LOCATE_BY_PROTOCOL, &pci_proto,
					NULL, &size, pci_handle);
M
Matt Fleming 已提交
159 160
	}

161
	if (status != EFI_SUCCESS)
M
Matt Fleming 已提交
162 163
		goto free_handle;

164 165 166 167 168
	data = (struct setup_data *)(unsigned long)params->hdr.setup_data;

	while (data && data->next)
		data = (struct setup_data *)(unsigned long)data->next;

169
	for_each_efi_handle(h, pci_handle, size, i) {
170 171 172
		efi_pci_io_protocol_t *pci = NULL;
		struct pci_setup_rom *rom;

173
		status = efi_call_early(handle_protocol, h,
174 175 176 177 178 179 180 181 182 183 184 185 186 187 188
					&pci_proto, (void **)&pci);
		if (status != EFI_SUCCESS || !pci)
			continue;

		status = preserve_pci_rom_image(pci, &rom);
		if (status != EFI_SUCCESS)
			continue;

		if (data)
			data->next = (unsigned long)rom;
		else
			params->hdr.setup_data = (unsigned long)rom;

		data = (struct setup_data *)rom;
	}
M
Matt Fleming 已提交
189

190
free_handle:
191
	efi_call_early(free_pool, pci_handle);
192
}
M
Matt Fleming 已提交
193

194 195 196 197 198 199
static void retrieve_apple_device_properties(struct boot_params *boot_params)
{
	efi_guid_t guid = APPLE_PROPERTIES_PROTOCOL_GUID;
	struct setup_data *data, *new;
	efi_status_t status;
	u32 size = 0;
200
	apple_properties_protocol_t *p;
201

202
	status = efi_call_early(locate_protocol, &guid, NULL, (void **)&p);
203 204 205 206 207 208 209 210 211 212 213 214 215 216
	if (status != EFI_SUCCESS)
		return;

	if (efi_table_attr(apple_properties_protocol, version, p) != 0x10000) {
		efi_printk(sys_table, "Unsupported properties proto version\n");
		return;
	}

	efi_call_proto(apple_properties_protocol, get_all, p, NULL, &size);
	if (!size)
		return;

	do {
		status = efi_call_early(allocate_pool, EFI_LOADER_DATA,
217 218
					size + sizeof(struct setup_data),
					(void **)&new);
219
		if (status != EFI_SUCCESS) {
I
Ingo Molnar 已提交
220
			efi_printk(sys_table, "Failed to allocate memory for 'properties'\n");
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235
			return;
		}

		status = efi_call_proto(apple_properties_protocol, get_all, p,
					new->data, &size);

		if (status == EFI_BUFFER_TOO_SMALL)
			efi_call_early(free_pool, new);
	} while (status == EFI_BUFFER_TOO_SMALL);

	new->type = SETUP_APPLE_PROPERTIES;
	new->len  = size;
	new->next = 0;

	data = (struct setup_data *)(unsigned long)boot_params->hdr.setup_data;
I
Ingo Molnar 已提交
236
	if (!data) {
237
		boot_params->hdr.setup_data = (unsigned long)new;
I
Ingo Molnar 已提交
238
	} else {
239 240 241 242 243 244
		while (data->next)
			data = (struct setup_data *)(unsigned long)data->next;
		data->next = (unsigned long)new;
	}
}

245 246
static const efi_char16_t apple[] = L"Apple";

247 248 249 250 251 252 253 254 255 256 257
static void setup_quirks(struct boot_params *boot_params)
{
	efi_char16_t *fw_vendor = (efi_char16_t *)(unsigned long)
		efi_table_attr(efi_system_table, fw_vendor, sys_table);

	if (!memcmp(fw_vendor, apple, sizeof(apple))) {
		if (IS_ENABLED(CONFIG_APPLE_PROPERTIES))
			retrieve_apple_device_properties(boot_params);
	}
}

258 259 260
/*
 * See if we have Universal Graphics Adapter (UGA) protocol
 */
261
static efi_status_t
262
setup_uga(struct screen_info *si, efi_guid_t *uga_proto, unsigned long size)
263
{
264 265 266
	efi_status_t status;
	u32 width, height;
	void **uga_handle = NULL;
267
	efi_uga_draw_protocol_t *uga = NULL, *first_uga;
268
	unsigned long nr_ugas;
269
	efi_handle_t handle;
270 271
	int i;

272 273 274 275
	status = efi_call_early(allocate_pool, EFI_LOADER_DATA,
				size, (void **)&uga_handle);
	if (status != EFI_SUCCESS)
		return status;
276

277 278 279 280 281
	status = efi_call_early(locate_handle,
				EFI_LOCATE_BY_PROTOCOL,
				uga_proto, NULL, &size, uga_handle);
	if (status != EFI_SUCCESS)
		goto free_handle;
M
Matt Fleming 已提交
282

283 284
	height = 0;
	width = 0;
285 286

	first_uga = NULL;
287
	for_each_efi_handle(handle, uga_handle, size, i) {
M
Matt Fleming 已提交
288 289 290 291
		efi_guid_t pciio_proto = EFI_PCI_IO_PROTOCOL_GUID;
		u32 w, h, depth, refresh;
		void *pciio;

292
		status = efi_call_early(handle_protocol, handle,
293
					uga_proto, (void **)&uga);
M
Matt Fleming 已提交
294 295 296
		if (status != EFI_SUCCESS)
			continue;

297
		pciio = NULL;
298
		efi_call_early(handle_protocol, handle, &pciio_proto, &pciio);
M
Matt Fleming 已提交
299

300 301
		status = efi_call_proto(efi_uga_draw_protocol, get_mode, uga,
					&w, &h, &depth, &refresh);
M
Matt Fleming 已提交
302
		if (status == EFI_SUCCESS && (!first_uga || pciio)) {
303 304
			width = w;
			height = h;
M
Matt Fleming 已提交
305 306 307 308 309 310 311 312 313 314 315 316

			/*
			 * Once we've found a UGA supporting PCIIO,
			 * don't bother looking any further.
			 */
			if (pciio)
				break;

			first_uga = uga;
		}
	}

317
	if (!width && !height)
M
Matt Fleming 已提交
318 319 320
		goto free_handle;

	/* EFI framebuffer */
I
Ingo Molnar 已提交
321
	si->orig_video_isVGA	= VIDEO_TYPE_EFI;
M
Matt Fleming 已提交
322

I
Ingo Molnar 已提交
323 324 325
	si->lfb_depth		= 32;
	si->lfb_width		= width;
	si->lfb_height		= height;
M
Matt Fleming 已提交
326

I
Ingo Molnar 已提交
327 328 329 330 331 332 333 334
	si->red_size		= 8;
	si->red_pos		= 16;
	si->green_size		= 8;
	si->green_pos		= 8;
	si->blue_size		= 8;
	si->blue_pos		= 0;
	si->rsvd_size		= 8;
	si->rsvd_pos		= 24;
M
Matt Fleming 已提交
335 336

free_handle:
337
	efi_call_early(free_pool, uga_handle);
I
Ingo Molnar 已提交
338

M
Matt Fleming 已提交
339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355
	return status;
}

void setup_graphics(struct boot_params *boot_params)
{
	efi_guid_t graphics_proto = EFI_GRAPHICS_OUTPUT_PROTOCOL_GUID;
	struct screen_info *si;
	efi_guid_t uga_proto = EFI_UGA_PROTOCOL_GUID;
	efi_status_t status;
	unsigned long size;
	void **gop_handle = NULL;
	void **uga_handle = NULL;

	si = &boot_params->screen_info;
	memset(si, 0, sizeof(*si));

	size = 0;
356 357 358
	status = efi_call_early(locate_handle,
				EFI_LOCATE_BY_PROTOCOL,
				&graphics_proto, NULL, &size, gop_handle);
M
Matt Fleming 已提交
359
	if (status == EFI_BUFFER_TOO_SMALL)
360
		status = efi_setup_gop(NULL, si, &graphics_proto, size);
M
Matt Fleming 已提交
361 362 363

	if (status != EFI_SUCCESS) {
		size = 0;
364 365 366
		status = efi_call_early(locate_handle,
					EFI_LOCATE_BY_PROTOCOL,
					&uga_proto, NULL, &size, uga_handle);
M
Matt Fleming 已提交
367 368 369 370 371 372 373 374 375
		if (status == EFI_BUFFER_TOO_SMALL)
			setup_uga(si, &uga_proto, size);
	}
}

/*
 * Because the x86 boot code expects to be passed a boot_params we
 * need to create one ourselves (usually the bootloader would create
 * one for us).
376 377 378
 *
 * The caller is responsible for filling out ->code32_start in the
 * returned boot_params.
M
Matt Fleming 已提交
379
 */
380
struct boot_params *make_boot_params(struct efi_config *c)
M
Matt Fleming 已提交
381
{
M
Matt Fleming 已提交
382 383 384 385
	struct boot_params *boot_params;
	struct apm_bios_info *bi;
	struct setup_header *hdr;
	efi_loaded_image_t *image;
386
	void *handle;
M
Matt Fleming 已提交
387
	efi_guid_t proto = LOADED_IMAGE_PROTOCOL_GUID;
M
Matt Fleming 已提交
388 389
	int options_size = 0;
	efi_status_t status;
390
	char *cmdline_ptr;
391 392
	unsigned long ramdisk_addr;
	unsigned long ramdisk_size;
M
Matt Fleming 已提交
393

394 395 396
	efi_early = c;
	sys_table = (efi_system_table_t *)(unsigned long)efi_early->table;
	handle = (void *)(unsigned long)efi_early->image_handle;
M
Matt Fleming 已提交
397 398 399 400 401

	/* Check if we were booted by the EFI firmware */
	if (sys_table->hdr.signature != EFI_SYSTEM_TABLE_SIGNATURE)
		return NULL;

402
	if (efi_is_64bit())
403 404 405 406
		setup_boot_services64(efi_early);
	else
		setup_boot_services32(efi_early);

407 408
	status = efi_call_early(handle_protocol, handle,
				&proto, (void *)&image);
M
Matt Fleming 已提交
409
	if (status != EFI_SUCCESS) {
410
		efi_printk(sys_table, "Failed to get handle for LOADED_IMAGE_PROTOCOL\n");
M
Matt Fleming 已提交
411 412 413
		return NULL;
	}

414 415
	status = efi_low_alloc(sys_table, 0x4000, 1,
			       (unsigned long *)&boot_params);
M
Matt Fleming 已提交
416
	if (status != EFI_SUCCESS) {
I
Ingo Molnar 已提交
417
		efi_printk(sys_table, "Failed to allocate lowmem for boot params\n");
M
Matt Fleming 已提交
418 419 420 421 422 423 424 425 426 427 428 429 430 431 432
		return NULL;
	}

	memset(boot_params, 0x0, 0x4000);

	hdr = &boot_params->hdr;
	bi = &boot_params->apm_bios_info;

	/* Copy the second sector to boot_params */
	memcpy(&hdr->jump, image->image_base + 512, 512);

	/*
	 * Fill out some of the header fields ourselves because the
	 * EFI firmware loader doesn't load the first sector.
	 */
I
Ingo Molnar 已提交
433 434 435
	hdr->root_flags	= 1;
	hdr->vid_mode	= 0xffff;
	hdr->boot_flag	= 0xAA55;
M
Matt Fleming 已提交
436

M
Matt Fleming 已提交
437 438 439
	hdr->type_of_loader = 0x21;

	/* Convert unicode cmdline to ascii */
440
	cmdline_ptr = efi_convert_cmdline(sys_table, image, &options_size);
441 442
	if (!cmdline_ptr)
		goto fail;
I
Ingo Molnar 已提交
443

444
	hdr->cmd_line_ptr = (unsigned long)cmdline_ptr;
445 446
	/* Fill in upper bits of command line address, NOP on 32 bit  */
	boot_params->ext_cmd_line_ptr = (u64)(unsigned long)cmdline_ptr >> 32;
M
Matt Fleming 已提交
447 448 449 450 451 452 453

	hdr->ramdisk_image = 0;
	hdr->ramdisk_size = 0;

	/* Clear APM BIOS info */
	memset(bi, 0, sizeof(*bi));

454 455 456 457
	status = efi_parse_options(cmdline_ptr);
	if (status != EFI_SUCCESS)
		goto fail2;

458 459
	status = handle_cmdline_files(sys_table, image,
				      (char *)(unsigned long)hdr->cmd_line_ptr,
460
				      "initrd=", hdr->initrd_addr_max,
461
				      &ramdisk_addr, &ramdisk_size);
462 463 464 465 466 467 468 469 470 471

	if (status != EFI_SUCCESS &&
	    hdr->xloadflags & XLF_CAN_BE_LOADED_ABOVE_4G) {
		efi_printk(sys_table, "Trying to load files to higher address\n");
		status = handle_cmdline_files(sys_table, image,
				      (char *)(unsigned long)hdr->cmd_line_ptr,
				      "initrd=", -1UL,
				      &ramdisk_addr, &ramdisk_size);
	}

M
Matt Fleming 已提交
472 473
	if (status != EFI_SUCCESS)
		goto fail2;
474 475 476 477
	hdr->ramdisk_image = ramdisk_addr & 0xffffffff;
	hdr->ramdisk_size  = ramdisk_size & 0xffffffff;
	boot_params->ext_ramdisk_image = (u64)ramdisk_addr >> 32;
	boot_params->ext_ramdisk_size  = (u64)ramdisk_size >> 32;
M
Matt Fleming 已提交
478 479

	return boot_params;
I
Ingo Molnar 已提交
480

M
Matt Fleming 已提交
481
fail2:
482
	efi_free(sys_table, options_size, hdr->cmd_line_ptr);
M
Matt Fleming 已提交
483
fail:
484
	efi_free(sys_table, 0x4000, (unsigned long)boot_params);
I
Ingo Molnar 已提交
485

M
Matt Fleming 已提交
486 487 488
	return NULL;
}

489 490
static void add_e820ext(struct boot_params *params,
			struct setup_data *e820ext, u32 nr_entries)
M
Matt Fleming 已提交
491
{
492
	struct setup_data *data;
M
Matt Fleming 已提交
493

494
	e820ext->type = SETUP_E820_EXT;
I
Ingo Molnar 已提交
495
	e820ext->len  = nr_entries * sizeof(struct boot_e820_entry);
496
	e820ext->next = 0;
M
Matt Fleming 已提交
497

498
	data = (struct setup_data *)(unsigned long)params->hdr.setup_data;
M
Matt Fleming 已提交
499

500 501
	while (data && data->next)
		data = (struct setup_data *)(unsigned long)data->next;
502

503 504 505 506 507
	if (data)
		data->next = (unsigned long)e820ext;
	else
		params->hdr.setup_data = (unsigned long)e820ext;
}
M
Matt Fleming 已提交
508

I
Ingo Molnar 已提交
509 510
static efi_status_t
setup_e820(struct boot_params *params, struct setup_data *e820ext, u32 e820ext_size)
511
{
512
	struct boot_e820_entry *entry = params->e820_table;
513
	struct efi_info *efi = &params->efi_info;
514
	struct boot_e820_entry *prev = NULL;
515 516 517
	u32 nr_entries;
	u32 nr_desc;
	int i;
M
Matt Fleming 已提交
518 519

	nr_entries = 0;
520 521 522
	nr_desc = efi->efi_memmap_size / efi->efi_memdesc_size;

	for (i = 0; i < nr_desc; i++) {
M
Matt Fleming 已提交
523 524
		efi_memory_desc_t *d;
		unsigned int e820_type = 0;
525
		unsigned long m = efi->efi_memmap;
M
Matt Fleming 已提交
526

527 528 529 530
#ifdef CONFIG_X86_64
		m |= (u64)efi->efi_memmap_hi << 32;
#endif

531
		d = efi_early_memdesc_ptr(m, efi->efi_memdesc_size, i);
M
Matt Fleming 已提交
532 533 534 535 536 537 538
		switch (d->type) {
		case EFI_RESERVED_TYPE:
		case EFI_RUNTIME_SERVICES_CODE:
		case EFI_RUNTIME_SERVICES_DATA:
		case EFI_MEMORY_MAPPED_IO:
		case EFI_MEMORY_MAPPED_IO_PORT_SPACE:
		case EFI_PAL_CODE:
539
			e820_type = E820_TYPE_RESERVED;
M
Matt Fleming 已提交
540 541 542
			break;

		case EFI_UNUSABLE_MEMORY:
543
			e820_type = E820_TYPE_UNUSABLE;
M
Matt Fleming 已提交
544 545 546
			break;

		case EFI_ACPI_RECLAIM_MEMORY:
547
			e820_type = E820_TYPE_ACPI;
M
Matt Fleming 已提交
548 549 550 551 552 553 554
			break;

		case EFI_LOADER_CODE:
		case EFI_LOADER_DATA:
		case EFI_BOOT_SERVICES_CODE:
		case EFI_BOOT_SERVICES_DATA:
		case EFI_CONVENTIONAL_MEMORY:
555 556 557 558 559
			if (efi_soft_reserve_enabled() &&
			    (d->attribute & EFI_MEMORY_SP))
				e820_type = E820_TYPE_SOFT_RESERVED;
			else
				e820_type = E820_TYPE_RAM;
M
Matt Fleming 已提交
560 561 562
			break;

		case EFI_ACPI_MEMORY_NVS:
563
			e820_type = E820_TYPE_NVS;
M
Matt Fleming 已提交
564 565
			break;

566
		case EFI_PERSISTENT_MEMORY:
567
			e820_type = E820_TYPE_PMEM;
568 569
			break;

M
Matt Fleming 已提交
570 571 572 573 574 575
		default:
			continue;
		}

		/* Merge adjacent mappings */
		if (prev && prev->type == e820_type &&
576
		    (prev->addr + prev->size) == d->phys_addr) {
M
Matt Fleming 已提交
577
			prev->size += d->num_pages << 12;
578
			continue;
M
Matt Fleming 已提交
579
		}
580

581
		if (nr_entries == ARRAY_SIZE(params->e820_table)) {
582
			u32 need = (nr_desc - i) * sizeof(struct e820_entry) +
583 584 585 586 587 588
				   sizeof(struct setup_data);

			if (!e820ext || e820ext_size < need)
				return EFI_BUFFER_TOO_SMALL;

			/* boot_params map full, switch to e820 extended */
589
			entry = (struct boot_e820_entry *)e820ext->data;
590 591
		}

592 593 594 595
		entry->addr = d->phys_addr;
		entry->size = d->num_pages << PAGE_SHIFT;
		entry->type = e820_type;
		prev = entry++;
596
		nr_entries++;
M
Matt Fleming 已提交
597 598
	}

599 600
	if (nr_entries > ARRAY_SIZE(params->e820_table)) {
		u32 nr_e820ext = nr_entries - ARRAY_SIZE(params->e820_table);
601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617

		add_e820ext(params, e820ext, nr_e820ext);
		nr_entries -= nr_e820ext;
	}

	params->e820_entries = (u8)nr_entries;

	return EFI_SUCCESS;
}

static efi_status_t alloc_e820ext(u32 nr_desc, struct setup_data **e820ext,
				  u32 *e820ext_size)
{
	efi_status_t status;
	unsigned long size;

	size = sizeof(struct setup_data) +
618
		sizeof(struct e820_entry) * nr_desc;
619 620

	if (*e820ext) {
621
		efi_call_early(free_pool, *e820ext);
622 623 624 625
		*e820ext = NULL;
		*e820ext_size = 0;
	}

626 627
	status = efi_call_early(allocate_pool, EFI_LOADER_DATA,
				size, (void **)e820ext);
628 629 630 631 632 633
	if (status == EFI_SUCCESS)
		*e820ext_size = size;

	return status;
}

634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667
static efi_status_t allocate_e820(struct boot_params *params,
				  struct setup_data **e820ext,
				  u32 *e820ext_size)
{
	unsigned long map_size, desc_size, buff_size;
	struct efi_boot_memmap boot_map;
	efi_memory_desc_t *map;
	efi_status_t status;
	__u32 nr_desc;

	boot_map.map		= &map;
	boot_map.map_size	= &map_size;
	boot_map.desc_size	= &desc_size;
	boot_map.desc_ver	= NULL;
	boot_map.key_ptr	= NULL;
	boot_map.buff_size	= &buff_size;

	status = efi_get_memory_map(sys_table, &boot_map);
	if (status != EFI_SUCCESS)
		return status;

	nr_desc = buff_size / desc_size;

	if (nr_desc > ARRAY_SIZE(params->e820_table)) {
		u32 nr_e820ext = nr_desc - ARRAY_SIZE(params->e820_table);

		status = alloc_e820ext(nr_e820ext, e820ext, e820ext_size);
		if (status != EFI_SUCCESS)
			return status;
	}

	return EFI_SUCCESS;
}

668
struct exit_boot_struct {
I
Ingo Molnar 已提交
669 670
	struct boot_params	*boot_params;
	struct efi_info		*efi;
671 672 673 674 675 676 677 678 679
};

static efi_status_t exit_boot_func(efi_system_table_t *sys_table_arg,
				   struct efi_boot_memmap *map,
				   void *priv)
{
	const char *signature;
	struct exit_boot_struct *p = priv;

680 681
	signature = efi_is_64bit() ? EFI64_LOADER_SIGNATURE
				   : EFI32_LOADER_SIGNATURE;
682 683
	memcpy(&p->efi->efi_loader_signature, signature, sizeof(__u32));

I
Ingo Molnar 已提交
684 685 686 687 688
	p->efi->efi_systab		= (unsigned long)sys_table_arg;
	p->efi->efi_memdesc_size	= *map->desc_size;
	p->efi->efi_memdesc_version	= *map->desc_ver;
	p->efi->efi_memmap		= (unsigned long)*map->map;
	p->efi->efi_memmap_size		= *map->map_size;
689 690

#ifdef CONFIG_X86_64
I
Ingo Molnar 已提交
691 692
	p->efi->efi_systab_hi		= (unsigned long)sys_table_arg >> 32;
	p->efi->efi_memmap_hi		= (unsigned long)*map->map >> 32;
693 694 695 696 697
#endif

	return EFI_SUCCESS;
}

698
static efi_status_t exit_boot(struct boot_params *boot_params, void *handle)
699
{
700
	unsigned long map_sz, key, desc_size, buff_size;
701
	efi_memory_desc_t *mem_map;
702 703
	struct setup_data *e820ext = NULL;
	__u32 e820ext_size = 0;
704 705
	efi_status_t status;
	__u32 desc_version;
706
	struct efi_boot_memmap map;
707 708
	struct exit_boot_struct priv;

I
Ingo Molnar 已提交
709 710 711 712 713 714 715 716
	map.map			= &mem_map;
	map.map_size		= &map_sz;
	map.desc_size		= &desc_size;
	map.desc_ver		= &desc_version;
	map.key_ptr		= &key;
	map.buff_size		= &buff_size;
	priv.boot_params	= boot_params;
	priv.efi		= &boot_params->efi_info;
717 718 719 720

	status = allocate_e820(boot_params, &e820ext, &e820ext_size);
	if (status != EFI_SUCCESS)
		return status;
721

722 723 724
	/* Might as well exit boot services now */
	status = efi_exit_boot_services(sys_table, handle, &map, &priv,
					exit_boot_func);
725 726 727 728
	if (status != EFI_SUCCESS)
		return status;

	/* Historic? */
I
Ingo Molnar 已提交
729
	boot_params->alt_mem_k	= 32 * 1024;
730 731 732 733

	status = setup_e820(boot_params, e820ext, e820ext_size);
	if (status != EFI_SUCCESS)
		return status;
M
Matt Fleming 已提交
734 735 736 737

	return EFI_SUCCESS;
}

M
Matt Fleming 已提交
738 739 740 741
/*
 * On success we return a pointer to a boot_params structure, and NULL
 * on failure.
 */
I
Ingo Molnar 已提交
742 743
struct boot_params *
efi_main(struct efi_config *c, struct boot_params *boot_params)
M
Matt Fleming 已提交
744
{
745
	struct desc_ptr *gdt = NULL;
M
Matt Fleming 已提交
746 747 748
	struct setup_header *hdr = &boot_params->hdr;
	efi_status_t status;
	struct desc_struct *desc;
749 750
	void *handle;
	efi_system_table_t *_table;
751
	unsigned long cmdline_paddr;
752 753 754 755 756

	efi_early = c;

	_table = (efi_system_table_t *)(unsigned long)efi_early->table;
	handle = (void *)(unsigned long)efi_early->image_handle;
M
Matt Fleming 已提交
757 758 759 760 761 762 763

	sys_table = _table;

	/* Check if we were booted by the EFI firmware */
	if (sys_table->hdr.signature != EFI_SYSTEM_TABLE_SIGNATURE)
		goto fail;

764
	if (efi_is_64bit())
765 766 767 768
		setup_boot_services64(efi_early);
	else
		setup_boot_services32(efi_early);

769 770 771 772 773 774 775 776 777
	/*
	 * make_boot_params() may have been called before efi_main(), in which
	 * case this is the second time we parse the cmdline. This is ok,
	 * parsing the cmdline multiple times does not have side-effects.
	 */
	cmdline_paddr = ((u64)hdr->cmd_line_ptr |
			 ((u64)boot_params->ext_cmd_line_ptr << 32));
	efi_parse_options((char *)cmdline_paddr);

778 779 780 781 782 783
	/*
	 * If the boot loader gave us a value for secure_boot then we use that,
	 * otherwise we ask the BIOS.
	 */
	if (boot_params->secure_boot == efi_secureboot_mode_unset)
		boot_params->secure_boot = efi_get_secureboot(sys_table);
784 785 786

	/* Ask the firmware to clear memory on unclean shutdown */
	efi_enable_reset_attack_mitigation(sys_table);
787 788 789

	efi_random_get_seed(sys_table);

790
	efi_retrieve_tpm2_eventlog(sys_table);
791

M
Matt Fleming 已提交
792
	setup_graphics(boot_params);
M
Matt Fleming 已提交
793

794
	setup_efi_pci(boot_params);
795

796 797
	setup_quirks(boot_params);

798 799
	status = efi_call_early(allocate_pool, EFI_LOADER_DATA,
				sizeof(*gdt), (void **)&gdt);
800
	if (status != EFI_SUCCESS) {
I
Ingo Molnar 已提交
801
		efi_printk(sys_table, "Failed to allocate memory for 'gdt' structure\n");
M
Matt Fleming 已提交
802
		goto fail;
803
	}
M
Matt Fleming 已提交
804 805

	gdt->size = 0x800;
806
	status = efi_low_alloc(sys_table, gdt->size, 8,
807
			   (unsigned long *)&gdt->address);
808
	if (status != EFI_SUCCESS) {
I
Ingo Molnar 已提交
809
		efi_printk(sys_table, "Failed to allocate memory for 'gdt'\n");
M
Matt Fleming 已提交
810
		goto fail;
811
	}
M
Matt Fleming 已提交
812

M
Matt Fleming 已提交
813 814 815 816 817
	/*
	 * If the kernel isn't already loaded at the preferred load
	 * address, relocate it.
	 */
	if (hdr->pref_address != hdr->code32_start) {
818 819 820 821
		unsigned long bzimage_addr = hdr->code32_start;
		status = efi_relocate_kernel(sys_table, &bzimage_addr,
					     hdr->init_size, hdr->init_size,
					     hdr->pref_address,
822 823
					     hdr->kernel_alignment,
					     LOAD_PHYSICAL_ADDR);
824 825
		if (status != EFI_SUCCESS) {
			efi_printk(sys_table, "efi_relocate_kernel() failed!\n");
M
Matt Fleming 已提交
826
			goto fail;
827
		}
828 829 830

		hdr->pref_address = hdr->code32_start;
		hdr->code32_start = bzimage_addr;
M
Matt Fleming 已提交
831 832
	}

833
	status = exit_boot(boot_params, handle);
834 835
	if (status != EFI_SUCCESS) {
		efi_printk(sys_table, "exit_boot() failed!\n");
M
Matt Fleming 已提交
836
		goto fail;
837
	}
M
Matt Fleming 已提交
838 839 840 841

	memset((char *)gdt->address, 0x0, gdt->size);
	desc = (struct desc_struct *)gdt->address;

842 843 844 845 846
	/* The first GDT is a dummy. */
	desc++;

	if (IS_ENABLED(CONFIG_X86_64)) {
		/* __KERNEL32_CS */
I
Ingo Molnar 已提交
847 848 849 850 851 852 853 854 855 856 857 858 859 860
		desc->limit0	= 0xffff;
		desc->base0	= 0x0000;
		desc->base1	= 0x0000;
		desc->type	= SEG_TYPE_CODE | SEG_TYPE_EXEC_READ;
		desc->s		= DESC_TYPE_CODE_DATA;
		desc->dpl	= 0;
		desc->p		= 1;
		desc->limit1	= 0xf;
		desc->avl	= 0;
		desc->l		= 0;
		desc->d		= SEG_OP_SIZE_32BIT;
		desc->g		= SEG_GRANULARITY_4KB;
		desc->base2	= 0x00;

861 862 863 864 865
		desc++;
	} else {
		/* Second entry is unused on 32-bit */
		desc++;
	}
M
Matt Fleming 已提交
866

867
	/* __KERNEL_CS */
I
Ingo Molnar 已提交
868 869 870 871 872 873 874 875 876 877
	desc->limit0	= 0xffff;
	desc->base0	= 0x0000;
	desc->base1	= 0x0000;
	desc->type	= SEG_TYPE_CODE | SEG_TYPE_EXEC_READ;
	desc->s		= DESC_TYPE_CODE_DATA;
	desc->dpl	= 0;
	desc->p		= 1;
	desc->limit1	= 0xf;
	desc->avl	= 0;

878 879 880 881 882 883 884
	if (IS_ENABLED(CONFIG_X86_64)) {
		desc->l = 1;
		desc->d = 0;
	} else {
		desc->l = 0;
		desc->d = SEG_OP_SIZE_32BIT;
	}
I
Ingo Molnar 已提交
885 886
	desc->g		= SEG_GRANULARITY_4KB;
	desc->base2	= 0x00;
M
Matt Fleming 已提交
887
	desc++;
888 889

	/* __KERNEL_DS */
I
Ingo Molnar 已提交
890 891 892 893 894 895 896 897 898 899 900 901 902
	desc->limit0	= 0xffff;
	desc->base0	= 0x0000;
	desc->base1	= 0x0000;
	desc->type	= SEG_TYPE_DATA | SEG_TYPE_READ_WRITE;
	desc->s		= DESC_TYPE_CODE_DATA;
	desc->dpl	= 0;
	desc->p		= 1;
	desc->limit1	= 0xf;
	desc->avl	= 0;
	desc->l		= 0;
	desc->d		= SEG_OP_SIZE_32BIT;
	desc->g		= SEG_GRANULARITY_4KB;
	desc->base2	= 0x00;
M
Matt Fleming 已提交
903
	desc++;
904 905 906

	if (IS_ENABLED(CONFIG_X86_64)) {
		/* Task segment value */
I
Ingo Molnar 已提交
907 908 909 910 911 912 913 914 915 916 917 918 919
		desc->limit0	= 0x0000;
		desc->base0	= 0x0000;
		desc->base1	= 0x0000;
		desc->type	= SEG_TYPE_TSS;
		desc->s		= 0;
		desc->dpl	= 0;
		desc->p		= 1;
		desc->limit1	= 0x0;
		desc->avl	= 0;
		desc->l		= 0;
		desc->d		= 0;
		desc->g		= SEG_GRANULARITY_4KB;
		desc->base2	= 0x00;
920 921
		desc++;
	}
M
Matt Fleming 已提交
922 923

	asm volatile("cli");
924
	asm volatile ("lgdt %0" : : "m" (*gdt));
M
Matt Fleming 已提交
925 926 927

	return boot_params;
fail:
928
	efi_printk(sys_table, "efi_main() failed!\n");
I
Ingo Molnar 已提交
929

M
Matt Fleming 已提交
930 931
	return NULL;
}