/*      $NetBSD: efibootx64.c,v 1.6 2023/04/20 00:42:24 manu Exp $      */

/*-
* Copyright (c) 2016 Kimihiro Nonaka <[email protected]>
* 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);
}