#include <unistd.h>
#include <errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <linux/kexec.h>
#include <linux/reboot.h>
#include <sys/reboot.h>
#include <sys/syscall.h>

asm(
    "  .code64\n"
    "  .data\n"
    "purgatory_start:\n"

    // Trigger kexec debug exception handling
    "  int3\n"

    // Set load address for next time
    "  leaq purgatory_start_b(%rip), %r11\n"
    "  movq %r11, 8(%rsp)\n"

    // Back to Linux
    "  ret\n"

    // Same again
    "purgatory_start_b:\n"

    // Trigger kexec debug exception handling
    "  int3\n"

    // Set load address for next time
    "  leaq purgatory_start(%rip), %r11\n"
    "  movq %r11, 8(%rsp)\n"

    // Back to Linux
    "  ret\n"

    "purgatory_end:\n"
    ".previous"
);
extern char purgatory_start[], purgatory_end[];

int main (void)
{
        struct kexec_segment segment = {};
 int ret;

 segment.buf = purgatory_start;
 segment.bufsz = purgatory_end - purgatory_start;
 segment.mem = (void *)0x400000;
 segment.memsz = 0x1000;
 ret = syscall(__NR_kexec_load, 0x400000, 1, &segment, KEXEC_PRESERVE_CONTEXT);
 if (ret) {
  perror("kexec_load");
  exit(1);
 }

 ret = syscall(__NR_reboot, LINUX_REBOOT_MAGIC1, LINUX_REBOOT_MAGIC2, LINUX_REBOOT_CMD_KEXEC);
 if (ret) {
  perror("kexec reboot");
  exit(1);
 }

 ret = syscall(__NR_reboot, LINUX_REBOOT_MAGIC1, LINUX_REBOOT_MAGIC2, LINUX_REBOOT_CMD_KEXEC);
 if (ret) {
  perror("kexec reboot");
  exit(1);
 }
 printf("Success\n");
 return 0;
}