/* SPDX-License-Identifier: GPL-2.0 */
/*
 * This file is included twice from vdso2c.c.  It generates code for 32-bit
 * and 64-bit vDSOs.  We need both for 64-bit builds, since 32-bit vDSOs
 * are built for 32-bit userspace.
 */

static void BITSFUNC(copy)(FILE *outfile, const unsigned char *data, size_t len)
{
        size_t i;

        for (i = 0; i < len; i++) {
                if (i % 10 == 0)
                        fprintf(outfile, "\n\t");
                fprintf(outfile, "0x%02X, ", (int)(data)[i]);
        }
}


/*
 * Extract a section from the input data into a standalone blob.  Used to
 * capture kernel-only data that needs to persist indefinitely, e.g. the
 * exception fixup tables, but only in the kernel, i.e. the section can
 * be stripped from the final vDSO image.
 */
static void BITSFUNC(extract)(const unsigned char *data, size_t data_len,
                              FILE *outfile, ELF(Shdr) *sec, const char *name)
{
        unsigned long offset;
        size_t len;

        offset = (unsigned long)GET_LE(&sec->sh_offset);
        len = (size_t)GET_LE(&sec->sh_size);

        if (offset + len > data_len)
                fail("section to extract overruns input data");

        fprintf(outfile, "static const unsigned char %s[%zu] = {", name, len);
        BITSFUNC(copy)(outfile, data + offset, len);
        fprintf(outfile, "\n};\n\n");
}

static void BITSFUNC(go)(void *raw_addr, size_t raw_len,
                         void *stripped_addr, size_t stripped_len,
                         FILE *outfile, const char *image_name)
{
        int found_load = 0;
        unsigned long load_size = -1;  /* Work around bogus warning */
        unsigned long mapping_size;
        ELF(Ehdr) *hdr = (ELF(Ehdr) *)raw_addr;
        unsigned long i, syms_nr;
        ELF(Shdr) *symtab_hdr = NULL, *strtab_hdr, *secstrings_hdr,
                *alt_sec = NULL, *extable_sec = NULL;
        ELF(Dyn) *dyn = 0, *dyn_end = 0;
        const char *secstrings;
        INT_BITS syms[NSYMS] = {};

        ELF(Phdr) *pt = (ELF(Phdr) *)(raw_addr + GET_LE(&hdr->e_phoff));

        if (GET_LE(&hdr->e_type) != ET_DYN)
                fail("input is not a shared object\n");

        /* Walk the segment table. */
        for (i = 0; i < GET_LE(&hdr->e_phnum); i++) {
                if (GET_LE(&pt[i].p_type) == PT_LOAD) {
                        if (found_load)
                                fail("multiple PT_LOAD segs\n");

                        if (GET_LE(&pt[i].p_offset) != 0 ||
                            GET_LE(&pt[i].p_vaddr) != 0)
                                fail("PT_LOAD in wrong place\n");

                        if (GET_LE(&pt[i].p_memsz) != GET_LE(&pt[i].p_filesz))
                                fail("cannot handle memsz != filesz\n");

                        load_size = GET_LE(&pt[i].p_memsz);
                        found_load = 1;
                } else if (GET_LE(&pt[i].p_type) == PT_DYNAMIC) {
                        dyn = raw_addr + GET_LE(&pt[i].p_offset);
                        dyn_end = raw_addr + GET_LE(&pt[i].p_offset) +
                                GET_LE(&pt[i].p_memsz);
                }
        }
        if (!found_load)
                fail("no PT_LOAD seg\n");

        if (stripped_len < load_size)
                fail("stripped input is too short\n");

        if (!dyn)
                fail("input has no PT_DYNAMIC section -- your toolchain is buggy\n");

        /* Walk the dynamic table */
        for (i = 0; dyn + i < dyn_end &&
                     GET_LE(&dyn[i].d_tag) != DT_NULL; i++) {
                typeof(dyn[i].d_tag) tag = GET_LE(&dyn[i].d_tag);
                if (tag == DT_REL || tag == DT_RELSZ || tag == DT_RELA ||
                    tag == DT_RELENT || tag == DT_TEXTREL)
                        fail("vdso image contains dynamic relocations\n");
        }

        /* Walk the section table */
        secstrings_hdr = raw_addr + GET_LE(&hdr->e_shoff) +
                GET_LE(&hdr->e_shentsize)*GET_LE(&hdr->e_shstrndx);
        secstrings = raw_addr + GET_LE(&secstrings_hdr->sh_offset);
        for (i = 0; i < GET_LE(&hdr->e_shnum); i++) {
                ELF(Shdr) *sh = raw_addr + GET_LE(&hdr->e_shoff) +
                        GET_LE(&hdr->e_shentsize) * i;
                if (GET_LE(&sh->sh_type) == SHT_SYMTAB)
                        symtab_hdr = sh;

                if (!strcmp(secstrings + GET_LE(&sh->sh_name),
                            ".altinstructions"))
                        alt_sec = sh;
                if (!strcmp(secstrings + GET_LE(&sh->sh_name), "__ex_table"))
                        extable_sec = sh;
        }

        if (!symtab_hdr)
                fail("no symbol table\n");

        strtab_hdr = raw_addr + GET_LE(&hdr->e_shoff) +
                GET_LE(&hdr->e_shentsize) * GET_LE(&symtab_hdr->sh_link);

        syms_nr = GET_LE(&symtab_hdr->sh_size) / GET_LE(&symtab_hdr->sh_entsize);
        /* Walk the symbol table */
        for (i = 0; i < syms_nr; i++) {
                unsigned int k;
                ELF(Sym) *sym = raw_addr + GET_LE(&symtab_hdr->sh_offset) +
                        GET_LE(&symtab_hdr->sh_entsize) * i;
                const char *sym_name = raw_addr +
                                       GET_LE(&strtab_hdr->sh_offset) +
                                       GET_LE(&sym->st_name);

                for (k = 0; k < NSYMS; k++) {
                        if (!strcmp(sym_name, required_syms[k].name)) {
                                if (syms[k]) {
                                        fail("duplicate symbol %s\n",
                                             required_syms[k].name);
                                }

                                /*
                                 * Careful: we use negative addresses, but
                                 * st_value is unsigned, so we rely
                                 * on syms[k] being a signed type of the
                                 * correct width.
                                 */
                                syms[k] = GET_LE(&sym->st_value);
                        }
                }
        }

        if (!image_name) {
                fwrite(stripped_addr, stripped_len, 1, outfile);
                return;
        }

        mapping_size = (stripped_len + 4095) / 4096 * 4096;

        fprintf(outfile, "/* AUTOMATICALLY GENERATED -- DO NOT EDIT */\n\n");
        fprintf(outfile, "#include <linux/linkage.h>\n");
        fprintf(outfile, "#include <linux/init.h>\n");
        fprintf(outfile, "#include <asm/page_types.h>\n");
        fprintf(outfile, "#include <asm/vdso.h>\n");
        fprintf(outfile, "\n");
        fprintf(outfile,
                "static unsigned char raw_data[%lu] __ro_after_init __aligned(PAGE_SIZE) = {",
                mapping_size);
        for (i = 0; i < stripped_len; i++) {
                if (i % 10 == 0)
                        fprintf(outfile, "\n\t");
                fprintf(outfile, "0x%02X, ",
                        (int)((unsigned char *)stripped_addr)[i]);
        }
        fprintf(outfile, "\n};\n\n");
        if (extable_sec)
                BITSFUNC(extract)(raw_addr, raw_len, outfile,
                                  extable_sec, "extable");

        fprintf(outfile, "const struct vdso_image %s = {\n", image_name);
        fprintf(outfile, "\t.data = raw_data,\n");
        fprintf(outfile, "\t.size = %lu,\n", mapping_size);
        if (alt_sec) {
                fprintf(outfile, "\t.alt = %lu,\n",
                        (unsigned long)GET_LE(&alt_sec->sh_offset));
                fprintf(outfile, "\t.alt_len = %lu,\n",
                        (unsigned long)GET_LE(&alt_sec->sh_size));
        }
        if (extable_sec) {
                fprintf(outfile, "\t.extable_base = %lu,\n",
                        (unsigned long)GET_LE(&extable_sec->sh_offset));
                fprintf(outfile, "\t.extable_len = %lu,\n",
                        (unsigned long)GET_LE(&extable_sec->sh_size));
                fprintf(outfile, "\t.extable = extable,\n");
        }

        for (i = 0; i < NSYMS; i++) {
                if (required_syms[i].export && syms[i])
                        fprintf(outfile, "\t.sym_%s = %" PRIi64 ",\n",
                                required_syms[i].name, (int64_t)syms[i]);
        }
        fprintf(outfile, "};\n\n");
        fprintf(outfile, "static __init int init_%s(void) {\n", image_name);
        fprintf(outfile, "\treturn init_vdso_image(&%s);\n", image_name);
        fprintf(outfile, "};\n");
        fprintf(outfile, "subsys_initcall(init_%s);\n", image_name);

}