/*	$NetBSD: efibootx64.c,v 1.4.6.2 2023/05/13 11:45:53 martin Exp $	*/

/*-
 * Copyright (c) 2016 Kimihiro Nonaka <nonaka@netbsd.org>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include "efiboot.h"

#include <sys/bootblock.h>

void startprog64_start(physaddr_t, physaddr_t, physaddr_t, u_long,
    void *, physaddr_t);
extern void (*startprog64)(physaddr_t, physaddr_t, physaddr_t, u_long,
    void *, physaddr_t);
extern u_int startprog64_size;

void multiboot64_start(physaddr_t, physaddr_t, uint32_t);
extern void (*multiboot64)(physaddr_t, physaddr_t, uint32_t);
extern u_int multiboot64_size;

void
efi_md_init(void)
{
	EFI_STATUS status;
	EFI_PHYSICAL_ADDRESS addr;
	u_int sz;

	addr = EFI_ALLOCATE_MAX_ADDRESS;
	sz = EFI_SIZE_TO_PAGES(startprog64_size);
	status = uefi_call_wrapper(BS->AllocatePages, 4, AllocateMaxAddress,
	    EfiLoaderData, sz, &addr);
	if (EFI_ERROR(status))
		panic("%s: AllocatePages() failed: %d page(s): %" PRIxMAX,
		    __func__, sz, (uintmax_t)status);
	startprog64 = (void *)addr;
	CopyMem(startprog64, startprog64_start, startprog64_size);

	addr = EFI_ALLOCATE_MAX_ADDRESS;
	sz = EFI_SIZE_TO_PAGES(multiboot64_size);
	status = uefi_call_wrapper(BS->AllocatePages, 4, AllocateMaxAddress,
	    EfiLoaderData, sz, &addr);
	if (EFI_ERROR(status))
		panic("%s: AllocatePages() failed: %d page(s): %" PRIxMAX,
		    __func__, sz, (uintmax_t)status);
	multiboot64 = (void *)addr;
	CopyMem(multiboot64, multiboot64_start, multiboot64_size);
}

/* ARGSUSED */
void
startprog(physaddr_t entry, uint32_t argc, uint32_t *argv, physaddr_t sp)
{
	uint32_t *newsp = (void *)((char *)startprog64 + startprog64_size);

	/* Copy argv to new stack pointer */
	if (argc > 0) {
		newsp -= argc;
		memcpy(newsp, argv, sizeof(*argv) * argc);
	}

	(*startprog64)(efi_kernel_start, efi_load_start,
	    (physaddr_t)newsp, efi_kernel_size, startprog64, entry);
}

/* ARGSUSED */
void
multiboot(physaddr_t entry, physaddr_t header, physaddr_t sp, uint32_t magic)
{
	(*multiboot64)(entry, header, magic);
}