/*
 * aarch64-rpi/mkboot.c
 *
 * Copyright (C) 2017 - 2021 bzt (bztsrc@gitlab)
 *
 * Permission is hereby granted, free of charge, to any person
 * obtaining a copy of this software and associated documentation
 * files (the "Software"), to deal in the Software without
 * restriction, including without limitation the rights to use, copy,
 * modify, merge, publish, distribute, sublicense, and/or sell copies
 * of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be
 * included in all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
 * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 *
 * This file is part of the BOOTBOOT Protocol package.
 * @brief Little tool to create a RPi compatible MBR for ESP
 *
 */

#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <fcntl.h>
#include <unistd.h>

/* entry point */
int main(int argc, char** argv)
{
    // variables
    unsigned char data[65536];
    unsigned int np,sp,i,es,ee;
    int f;

    // check arguments
    if(argc < 2) {
        printf( "BOOTBOOT mkboot utility - bztsrc@gitlab\n\nUsage:\n"
                "  ./mkboot <disk>\n\n"
                "Maps GPT EFI System Partition into MBR so that Raspberry Pi\n"
                "firmware can find it's files and boot from it.\n"
                "Examples:\n"
                "  ./mkboot diskimage.dd      - modify a disk image file\n"
                "  ./mkboot /dev/sda          - modify a real disk\n");
        return 1;
    }
    // open file
    f = open(argv[1], O_RDONLY);
    if(f < 0) {
        fprintf(stderr, "mkboot: file not found\n");
        return 2;
    }
    // read the partitioning tables
    if(read(f, data, 65536)==-1) {
        close(f);
        fprintf(stderr, "mkboot: unable to read file\n");
        return 2;
    }
    close(f);
    if(memcmp((void*)&data[512], "EFI PART", 8)) {
        fprintf(stderr, "mkboot: GPT partitioning table not found\n");
        return 2;
    }
    // get number of partitions and size of partition entry
    np=*((unsigned int*)&data[512+80]); sp=*((unsigned int*)&data[512+84]);
    i=*((unsigned int*)&data[512+72])*512; es=ee=0;
    // get esp start and esp end sectors
    while(np--) {
        if(*((unsigned int*)&data[i])==0xC12A7328 && *((unsigned int*)&data[i+4])==0x11D2F81F) {
            es=*((unsigned int*)&data[i+32]); ee=*((unsigned int*)&data[i+40]); break;
        }
        i+=sp;
    }
    if(es==0 || ee==0 || ee<es+1) {
        fprintf(stderr, "mkboot: ESP not found in GPT\n");
        return 2;
    }
    // if first MBR partition is not a FAT, make space for it
    if(data[0x1C2]!=0xC/*FAT32 LBA*/ && data[0x1C2]!=0xE/*FAT16 LBA*/) {
        memcpy((void*)&data+0x1EE, (void*)&data+0x1DE, 16);
        memcpy((void*)&data+0x1DE, (void*)&data+0x1CE, 16);
        memcpy((void*)&data+0x1CE, (void*)&data+0x1BE, 16);
        data[0x1C2]=0xC;
    }
    // check if it's already pointing to ESP
    ee-=sp-1;
    if(*((unsigned int*)&data[0x1C6])==es && *((unsigned int*)&data[0x1CA])==ee) {
        fprintf(stderr, "mkboot: ESP already mapped to MBR, nothing to do\n");
        return 0;
    }
    *((unsigned int*)&data[0x1C6])=es;
    *((unsigned int*)&data[0x1CA])=ee;

    // save boot record
    f = open(argv[1], O_WRONLY);
    if(f < 0 || write(f, data, 512) <= 0) {
        fprintf(stderr, "mkboot: unable to write MBR\n");
        return 3;
    }
    close(f);
    // all went well
    printf("mkboot: GPT ESP mapped to MBR successfully\n");
}