// SPDX-License-Identifier: GPL-2.0-only
/*
 * Coredump functionality for Remoteproc framework.
 *
 * Copyright (c) 2020, The Linux Foundation. All rights reserved.
 */

#include <linux/completion.h>
#include <linux/devcoredump.h>
#include <linux/device.h>
#include <linux/kernel.h>
#include <linux/remoteproc.h>
#include "remoteproc_internal.h"
#include "remoteproc_elf_helpers.h"

struct rproc_coredump_state {
        struct rproc *rproc;
        void *header;
        struct completion dump_done;
};

/**
 * rproc_coredump_cleanup() - clean up dump_segments list
 * @rproc: the remote processor handle
 */
void rproc_coredump_cleanup(struct rproc *rproc)
{
        struct rproc_dump_segment *entry, *tmp;

        list_for_each_entry_safe(entry, tmp, &rproc->dump_segments, node) {
                list_del(&entry->node);
                kfree(entry);
        }
}

/**
 * rproc_coredump_add_segment() - add segment of device memory to coredump
 * @rproc:      handle of a remote processor
 * @da:         device address
 * @size:       size of segment
 *
 * Add device memory to the list of segments to be included in a coredump for
 * the remoteproc.
 *
 * Return: 0 on success, negative errno on error.
 */
int rproc_coredump_add_segment(struct rproc *rproc, dma_addr_t da, size_t size)
{
        struct rproc_dump_segment *segment;

        segment = kzalloc(sizeof(*segment), GFP_KERNEL);
        if (!segment)
                return -ENOMEM;

        segment->da = da;
        segment->size = size;

        list_add_tail(&segment->node, &rproc->dump_segments);

        return 0;
}
EXPORT_SYMBOL(rproc_coredump_add_segment);

/**
 * rproc_coredump_add_custom_segment() - add custom coredump segment
 * @rproc:      handle of a remote processor
 * @da:         device address
 * @size:       size of segment
 * @dumpfn:     custom dump function called for each segment during coredump
 * @priv:       private data
 *
 * Add device memory to the list of segments to be included in the coredump
 * and associate the segment with the given custom dump function and private
 * data.
 *
 * Return: 0 on success, negative errno on error.
 */
int rproc_coredump_add_custom_segment(struct rproc *rproc,
                                      dma_addr_t da, size_t size,
                                      void (*dumpfn)(struct rproc *rproc,
                                                     struct rproc_dump_segment *segment,
                                                     void *dest, size_t offset,
                                                     size_t size),
                                      void *priv)
{
        struct rproc_dump_segment *segment;

        segment = kzalloc(sizeof(*segment), GFP_KERNEL);
        if (!segment)
                return -ENOMEM;

        segment->da = da;
        segment->size = size;
        segment->priv = priv;
        segment->dump = dumpfn;

        list_add_tail(&segment->node, &rproc->dump_segments);

        return 0;
}
EXPORT_SYMBOL(rproc_coredump_add_custom_segment);

/**
 * rproc_coredump_set_elf_info() - set coredump elf information
 * @rproc:      handle of a remote processor
 * @class:      elf class for coredump elf file
 * @machine:    elf machine for coredump elf file
 *
 * Set elf information which will be used for coredump elf file.
 *
 * Return: 0 on success, negative errno on error.
 */
int rproc_coredump_set_elf_info(struct rproc *rproc, u8 class, u16 machine)
{
        if (class != ELFCLASS64 && class != ELFCLASS32)
                return -EINVAL;

        rproc->elf_class = class;
        rproc->elf_machine = machine;

        return 0;
}
EXPORT_SYMBOL(rproc_coredump_set_elf_info);

static void rproc_coredump_free(void *data)
{
        struct rproc_coredump_state *dump_state = data;

        vfree(dump_state->header);
        complete(&dump_state->dump_done);
}

static void *rproc_coredump_find_segment(loff_t user_offset,
                                         struct list_head *segments,
                                         size_t *data_left)
{
        struct rproc_dump_segment *segment;

        list_for_each_entry(segment, segments, node) {
                if (user_offset < segment->size) {
                        *data_left = segment->size - user_offset;
                        return segment;
                }
                user_offset -= segment->size;
        }

        *data_left = 0;
        return NULL;
}

static void rproc_copy_segment(struct rproc *rproc, void *dest,
                               struct rproc_dump_segment *segment,
                               size_t offset, size_t size)
{
        void *ptr;
        bool is_iomem;

        if (segment->dump) {
                segment->dump(rproc, segment, dest, offset, size);
        } else {
                ptr = rproc_da_to_va(rproc, segment->da + offset, size, &is_iomem);
                if (!ptr) {
                        dev_err(&rproc->dev,
                                "invalid copy request for segment %pad with offset %zu and size %zu)\n",
                                &segment->da, offset, size);
                        memset(dest, 0xff, size);
                } else {
                        if (is_iomem)
                                memcpy_fromio(dest, ptr, size);
                        else
                                memcpy(dest, ptr, size);
                }
        }
}

static ssize_t rproc_coredump_read(char *buffer, loff_t offset, size_t count,
                                   void *data, size_t header_sz)
{
        size_t seg_data, bytes_left = count;
        ssize_t copy_sz;
        struct rproc_dump_segment *seg;
        struct rproc_coredump_state *dump_state = data;
        struct rproc *rproc = dump_state->rproc;
        void *elfcore = dump_state->header;

        /* Copy the vmalloc'ed header first. */
        if (offset < header_sz) {
                copy_sz = memory_read_from_buffer(buffer, count, &offset,
                                                  elfcore, header_sz);

                return copy_sz;
        }

        /*
         * Find out the segment memory chunk to be copied based on offset.
         * Keep copying data until count bytes are read.
         */
        while (bytes_left) {
                seg = rproc_coredump_find_segment(offset - header_sz,
                                                  &rproc->dump_segments,
                                                  &seg_data);
                /* EOF check */
                if (!seg) {
                        dev_info(&rproc->dev, "Ramdump done, %lld bytes read",
                                 offset);
                        break;
                }

                copy_sz = min_t(size_t, bytes_left, seg_data);

                rproc_copy_segment(rproc, buffer, seg, seg->size - seg_data,
                                   copy_sz);

                offset += copy_sz;
                buffer += copy_sz;
                bytes_left -= copy_sz;
        }

        return count - bytes_left;
}

/**
 * rproc_coredump() - perform coredump
 * @rproc:      rproc handle
 *
 * This function will generate an ELF header for the registered segments
 * and create a devcoredump device associated with rproc. Based on the
 * coredump configuration this function will directly copy the segments
 * from device memory to userspace or copy segments from device memory to
 * a separate buffer, which can then be read by userspace.
 * The first approach avoids using extra vmalloc memory. But it will stall
 * recovery flow until dump is read by userspace.
 */
void rproc_coredump(struct rproc *rproc)
{
        struct rproc_dump_segment *segment;
        void *phdr;
        void *ehdr;
        size_t data_size;
        size_t offset;
        void *data;
        u8 class = rproc->elf_class;
        int phnum = 0;
        struct rproc_coredump_state dump_state;
        enum rproc_dump_mechanism dump_conf = rproc->dump_conf;

        if (list_empty(&rproc->dump_segments) ||
            dump_conf == RPROC_COREDUMP_DISABLED)
                return;

        if (class == ELFCLASSNONE) {
                dev_err(&rproc->dev, "Elf class is not set\n");
                return;
        }

        data_size = elf_size_of_hdr(class);
        list_for_each_entry(segment, &rproc->dump_segments, node) {
                /*
                 * For default configuration buffer includes headers & segments.
                 * For inline dump buffer just includes headers as segments are
                 * directly read from device memory.
                 */
                data_size += elf_size_of_phdr(class);
                if (dump_conf == RPROC_COREDUMP_ENABLED)
                        data_size += segment->size;

                phnum++;
        }

        data = vmalloc(data_size);
        if (!data)
                return;

        ehdr = data;

        memset(ehdr, 0, elf_size_of_hdr(class));
        /* e_ident field is common for both elf32 and elf64 */
        elf_hdr_init_ident(ehdr, class);

        elf_hdr_set_e_type(class, ehdr, ET_CORE);
        elf_hdr_set_e_machine(class, ehdr, rproc->elf_machine);
        elf_hdr_set_e_version(class, ehdr, EV_CURRENT);
        elf_hdr_set_e_entry(class, ehdr, rproc->bootaddr);
        elf_hdr_set_e_phoff(class, ehdr, elf_size_of_hdr(class));
        elf_hdr_set_e_ehsize(class, ehdr, elf_size_of_hdr(class));
        elf_hdr_set_e_phentsize(class, ehdr, elf_size_of_phdr(class));
        elf_hdr_set_e_phnum(class, ehdr, phnum);

        phdr = data + elf_hdr_get_e_phoff(class, ehdr);
        offset = elf_hdr_get_e_phoff(class, ehdr);
        offset += elf_size_of_phdr(class) * elf_hdr_get_e_phnum(class, ehdr);

        list_for_each_entry(segment, &rproc->dump_segments, node) {
                memset(phdr, 0, elf_size_of_phdr(class));
                elf_phdr_set_p_type(class, phdr, PT_LOAD);
                elf_phdr_set_p_offset(class, phdr, offset);
                elf_phdr_set_p_vaddr(class, phdr, segment->da);
                elf_phdr_set_p_paddr(class, phdr, segment->da);
                elf_phdr_set_p_filesz(class, phdr, segment->size);
                elf_phdr_set_p_memsz(class, phdr, segment->size);
                elf_phdr_set_p_flags(class, phdr, PF_R | PF_W | PF_X);
                elf_phdr_set_p_align(class, phdr, 0);

                if (dump_conf == RPROC_COREDUMP_ENABLED)
                        rproc_copy_segment(rproc, data + offset, segment, 0,
                                           segment->size);

                offset += elf_phdr_get_p_filesz(class, phdr);
                phdr += elf_size_of_phdr(class);
        }
        if (dump_conf == RPROC_COREDUMP_ENABLED) {
                dev_coredumpv(&rproc->dev, data, data_size, GFP_KERNEL);
                return;
        }

        /* Initialize the dump state struct to be used by rproc_coredump_read */
        dump_state.rproc = rproc;
        dump_state.header = data;
        init_completion(&dump_state.dump_done);

        dev_coredumpm(&rproc->dev, NULL, &dump_state, data_size, GFP_KERNEL,
                      rproc_coredump_read, rproc_coredump_free);

        /*
         * Wait until the dump is read and free is called. Data is freed
         * by devcoredump framework automatically after 5 minutes.
         */
        wait_for_completion(&dump_state.dump_done);
}

/**
 * rproc_coredump_using_sections() - perform coredump using section headers
 * @rproc:      rproc handle
 *
 * This function will generate an ELF header for the registered sections of
 * segments and create a devcoredump device associated with rproc. Based on
 * the coredump configuration this function will directly copy the segments
 * from device memory to userspace or copy segments from device memory to
 * a separate buffer, which can then be read by userspace.
 * The first approach avoids using extra vmalloc memory. But it will stall
 * recovery flow until dump is read by userspace.
 */
void rproc_coredump_using_sections(struct rproc *rproc)
{
        struct rproc_dump_segment *segment;
        void *shdr;
        void *ehdr;
        size_t data_size;
        size_t strtbl_size = 0;
        size_t strtbl_index = 1;
        size_t offset;
        void *data;
        u8 class = rproc->elf_class;
        int shnum;
        struct rproc_coredump_state dump_state;
        unsigned int dump_conf = rproc->dump_conf;
        char *str_tbl = "STR_TBL";

        if (list_empty(&rproc->dump_segments) ||
            dump_conf == RPROC_COREDUMP_DISABLED)
                return;

        if (class == ELFCLASSNONE) {
                dev_err(&rproc->dev, "Elf class is not set\n");
                return;
        }

        /*
         * We allocate two extra section headers. The first one is null.
         * Second section header is for the string table. Also space is
         * allocated for string table.
         */
        data_size = elf_size_of_hdr(class) + 2 * elf_size_of_shdr(class);
        shnum = 2;

        /* the extra byte is for the null character at index 0 */
        strtbl_size += strlen(str_tbl) + 2;

        list_for_each_entry(segment, &rproc->dump_segments, node) {
                data_size += elf_size_of_shdr(class);
                strtbl_size += strlen(segment->priv) + 1;
                if (dump_conf == RPROC_COREDUMP_ENABLED)
                        data_size += segment->size;
                shnum++;
        }

        data_size += strtbl_size;

        data = vmalloc(data_size);
        if (!data)
                return;

        ehdr = data;
        memset(ehdr, 0, elf_size_of_hdr(class));
        /* e_ident field is common for both elf32 and elf64 */
        elf_hdr_init_ident(ehdr, class);

        elf_hdr_set_e_type(class, ehdr, ET_CORE);
        elf_hdr_set_e_machine(class, ehdr, rproc->elf_machine);
        elf_hdr_set_e_version(class, ehdr, EV_CURRENT);
        elf_hdr_set_e_entry(class, ehdr, rproc->bootaddr);
        elf_hdr_set_e_shoff(class, ehdr, elf_size_of_hdr(class));
        elf_hdr_set_e_ehsize(class, ehdr, elf_size_of_hdr(class));
        elf_hdr_set_e_shentsize(class, ehdr, elf_size_of_shdr(class));
        elf_hdr_set_e_shnum(class, ehdr, shnum);
        elf_hdr_set_e_shstrndx(class, ehdr, 1);

        /*
         * The zeroth index of the section header is reserved and is rarely used.
         * Set the section header as null (SHN_UNDEF) and move to the next one.
         */
        shdr = data + elf_hdr_get_e_shoff(class, ehdr);
        memset(shdr, 0, elf_size_of_shdr(class));
        shdr += elf_size_of_shdr(class);

        /* Initialize the string table. */
        offset = elf_hdr_get_e_shoff(class, ehdr) +
                 elf_size_of_shdr(class) * elf_hdr_get_e_shnum(class, ehdr);
        memset(data + offset, 0, strtbl_size);

        /* Fill in the string table section header. */
        memset(shdr, 0, elf_size_of_shdr(class));
        elf_shdr_set_sh_type(class, shdr, SHT_STRTAB);
        elf_shdr_set_sh_offset(class, shdr, offset);
        elf_shdr_set_sh_size(class, shdr, strtbl_size);
        elf_shdr_set_sh_entsize(class, shdr, 0);
        elf_shdr_set_sh_flags(class, shdr, 0);
        elf_shdr_set_sh_name(class, shdr, elf_strtbl_add(str_tbl, ehdr, class, &strtbl_index));
        offset += elf_shdr_get_sh_size(class, shdr);
        shdr += elf_size_of_shdr(class);

        list_for_each_entry(segment, &rproc->dump_segments, node) {
                memset(shdr, 0, elf_size_of_shdr(class));
                elf_shdr_set_sh_type(class, shdr, SHT_PROGBITS);
                elf_shdr_set_sh_offset(class, shdr, offset);
                elf_shdr_set_sh_addr(class, shdr, segment->da);
                elf_shdr_set_sh_size(class, shdr, segment->size);
                elf_shdr_set_sh_entsize(class, shdr, 0);
                elf_shdr_set_sh_flags(class, shdr, SHF_WRITE);
                elf_shdr_set_sh_name(class, shdr,
                                     elf_strtbl_add(segment->priv, ehdr, class, &strtbl_index));

                /* No need to copy segments for inline dumps */
                if (dump_conf == RPROC_COREDUMP_ENABLED)
                        rproc_copy_segment(rproc, data + offset, segment, 0,
                                           segment->size);
                offset += elf_shdr_get_sh_size(class, shdr);
                shdr += elf_size_of_shdr(class);
        }

        if (dump_conf == RPROC_COREDUMP_ENABLED) {
                dev_coredumpv(&rproc->dev, data, data_size, GFP_KERNEL);
                return;
        }

        /* Initialize the dump state struct to be used by rproc_coredump_read */
        dump_state.rproc = rproc;
        dump_state.header = data;
        init_completion(&dump_state.dump_done);

        dev_coredumpm(&rproc->dev, NULL, &dump_state, data_size, GFP_KERNEL,
                      rproc_coredump_read, rproc_coredump_free);

        /* Wait until the dump is read and free is called. Data is freed
         * by devcoredump framework automatically after 5 minutes.
         */
        wait_for_completion(&dump_state.dump_done);
}
EXPORT_SYMBOL(rproc_coredump_using_sections);