/*
 * Copyright (C) 2019 Alyssa Rosenzweig
 * Copyright (C) 2017-2018 Lyude Paul
 * Copyright (C) 2019 Collabora, Ltd.
 *
 * 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 (including the next
 * paragraph) 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.
 */

#include <stdio.h>
#include <stdlib.h>
#include <assert.h>
#include <stdint.h>
#include <string.h>
#include <sys/mman.h>

#include "decode.h"
#include "util/macros.h"
#include "util/u_debug.h"
#include "util/u_dynarray.h"
#include "util/simple_mtx.h"

FILE *pandecode_dump_stream;

/* Memory handling */

static struct rb_tree mmap_tree;

static struct util_dynarray ro_mappings;

static simple_mtx_t pandecode_lock = _SIMPLE_MTX_INITIALIZER_NP;

#define to_mapped_memory(x) \
	rb_node_data(struct pandecode_mapped_memory, x, node)

/*
 * Compare a GPU VA to a node, considering a GPU VA to be equal to a node if it
 * is contained in the interval the node represents. This lets us store
 * intervals in our tree.
 */
static int
pandecode_cmp_key(const struct rb_node *lhs, const void *key)
{
        struct pandecode_mapped_memory *mem = to_mapped_memory(lhs);
        uint64_t *gpu_va = (uint64_t *) key;

        if (mem->gpu_va <= *gpu_va && *gpu_va < (mem->gpu_va + mem->length))
                return 0;
        else
                return mem->gpu_va - *gpu_va;
}

static int
pandecode_cmp(const struct rb_node *lhs, const struct rb_node *rhs)
{
        return to_mapped_memory(lhs)->gpu_va - to_mapped_memory(rhs)->gpu_va;
}

static struct pandecode_mapped_memory *
pandecode_find_mapped_gpu_mem_containing_rw(uint64_t addr)
{
        simple_mtx_assert_locked(&pandecode_lock);

        struct rb_node *node = rb_tree_search(&mmap_tree, &addr, pandecode_cmp_key);

        return to_mapped_memory(node);
}

struct pandecode_mapped_memory *
pandecode_find_mapped_gpu_mem_containing(uint64_t addr)
{
        simple_mtx_assert_locked(&pandecode_lock);

        struct pandecode_mapped_memory *mem = pandecode_find_mapped_gpu_mem_containing_rw(addr);

        if (mem && mem->addr && !mem->ro) {
                mprotect(mem->addr, mem->length, PROT_READ);
                mem->ro = true;
                util_dynarray_append(&ro_mappings, struct pandecode_mapped_memory *, mem);
        }

        return mem;
}

void
pandecode_map_read_write(void)
{
        simple_mtx_assert_locked(&pandecode_lock);

        util_dynarray_foreach(&ro_mappings, struct pandecode_mapped_memory *, mem) {
                (*mem)->ro = false;
                mprotect((*mem)->addr, (*mem)->length, PROT_READ | PROT_WRITE);
        }
        util_dynarray_clear(&ro_mappings);
}

static void
pandecode_add_name(struct pandecode_mapped_memory *mem, uint64_t gpu_va, const char *name)
{
        simple_mtx_assert_locked(&pandecode_lock);

        if (!name) {
                /* If we don't have a name, assign one */

                snprintf(mem->name, sizeof(mem->name) - 1,
                         "memory_%" PRIx64, gpu_va);
        } else {
                assert((strlen(name) + 1) < sizeof(mem->name));
                memcpy(mem->name, name, strlen(name) + 1);
        }
}

void
pandecode_inject_mmap(uint64_t gpu_va, void *cpu, unsigned sz, const char *name)
{
        simple_mtx_lock(&pandecode_lock);

        /* First, search if we already mapped this and are just updating an address */

        struct pandecode_mapped_memory *existing =
                pandecode_find_mapped_gpu_mem_containing_rw(gpu_va);

        if (existing && existing->gpu_va == gpu_va) {
                existing->length = sz;
                existing->addr = cpu;
                pandecode_add_name(existing, gpu_va, name);
        } else {
                /* Otherwise, add a fresh mapping */
                struct pandecode_mapped_memory *mapped_mem = NULL;

                mapped_mem = calloc(1, sizeof(*mapped_mem));
                mapped_mem->gpu_va = gpu_va;
                mapped_mem->length = sz;
                mapped_mem->addr = cpu;
                pandecode_add_name(mapped_mem, gpu_va, name);

                /* Add it to the tree */
                rb_tree_insert(&mmap_tree, &mapped_mem->node, pandecode_cmp);
        }

        simple_mtx_unlock(&pandecode_lock);
}

void
pandecode_inject_free(uint64_t gpu_va, unsigned sz)
{
        simple_mtx_lock(&pandecode_lock);

        struct pandecode_mapped_memory *mem =
                pandecode_find_mapped_gpu_mem_containing_rw(gpu_va);

        if (mem) {
                assert(mem->gpu_va == gpu_va);
                assert(mem->length == sz);

                rb_tree_remove(&mmap_tree, &mem->node);
                free(mem);
        }

        simple_mtx_unlock(&pandecode_lock);
}

char *
pointer_as_memory_reference(uint64_t ptr)
{
        simple_mtx_assert_locked(&pandecode_lock);

        struct pandecode_mapped_memory *mapped;
        char *out = malloc(128);

        /* Try to find the corresponding mapped zone */

        mapped = pandecode_find_mapped_gpu_mem_containing_rw(ptr);

        if (mapped) {
                snprintf(out, 128, "%s + %d", mapped->name, (int) (ptr - mapped->gpu_va));
                return out;
        }

        /* Just use the raw address if other options are exhausted */

        snprintf(out, 128, "0x%" PRIx64, ptr);
        return out;

}

static int pandecode_dump_frame_count = 0;

static bool force_stderr = false;

void
pandecode_dump_file_open(void)
{
        simple_mtx_assert_locked(&pandecode_lock);

        if (pandecode_dump_stream)
                return;

        /* This does a getenv every frame, so it is possible to use
         * setenv to change the base at runtime.
         */
        const char *dump_file_base = debug_get_option("PANDECODE_DUMP_FILE", "pandecode.dump");
        if (force_stderr || !strcmp(dump_file_base, "stderr"))
                pandecode_dump_stream = stderr;
        else {
                char buffer[1024];
                snprintf(buffer, sizeof(buffer), "%s.%04d", dump_file_base, pandecode_dump_frame_count);
                printf("pandecode: dump command stream to file %s\n", buffer);
                pandecode_dump_stream = fopen(buffer, "w");
                if (!pandecode_dump_stream)
                        fprintf(stderr,
                                "pandecode: failed to open command stream log file %s\n",
                                buffer);
        }
}

static void
pandecode_dump_file_close(void)
{
        simple_mtx_assert_locked(&pandecode_lock);

        if (pandecode_dump_stream && pandecode_dump_stream != stderr) {
                if (fclose(pandecode_dump_stream))
                        perror("pandecode: dump file");

                pandecode_dump_stream = NULL;
        }
}

void
pandecode_initialize(bool to_stderr)
{
        force_stderr = to_stderr;
        rb_tree_init(&mmap_tree);
        util_dynarray_init(&ro_mappings, NULL);
}

void
pandecode_next_frame(void)
{
        simple_mtx_lock(&pandecode_lock);

        pandecode_dump_file_close();
        pandecode_dump_frame_count++;

        simple_mtx_unlock(&pandecode_lock);
}

void
pandecode_close(void)
{
        simple_mtx_lock(&pandecode_lock);

        rb_tree_foreach_safe(struct pandecode_mapped_memory, it, &mmap_tree, node) {
                rb_tree_remove(&mmap_tree, &it->node);
                free(it);
        }

        util_dynarray_fini(&ro_mappings);
        pandecode_dump_file_close();

        simple_mtx_unlock(&pandecode_lock);
}

void
pandecode_dump_mappings(void)
{
        simple_mtx_lock(&pandecode_lock);

        pandecode_dump_file_open();

        rb_tree_foreach(struct pandecode_mapped_memory, it, &mmap_tree, node) {
                if (!it->addr || !it->length)
                        continue;

                fprintf(pandecode_dump_stream, "Buffer: %s gpu %" PRIx64 "\n\n",
                        it->name, it->gpu_va);

                pan_hexdump(pandecode_dump_stream, it->addr, it->length, false);
                fprintf(pandecode_dump_stream, "\n");
        }

        fflush(pandecode_dump_stream);
        simple_mtx_unlock(&pandecode_lock);
}

void pandecode_abort_on_fault_v4(mali_ptr jc_gpu_va);
void pandecode_abort_on_fault_v5(mali_ptr jc_gpu_va);
void pandecode_abort_on_fault_v6(mali_ptr jc_gpu_va);
void pandecode_abort_on_fault_v7(mali_ptr jc_gpu_va);
void pandecode_abort_on_fault_v9(mali_ptr jc_gpu_va);

void
pandecode_abort_on_fault(mali_ptr jc_gpu_va, unsigned gpu_id)
{
        simple_mtx_lock(&pandecode_lock);

        switch (pan_arch(gpu_id)) {
        case 4: pandecode_abort_on_fault_v4(jc_gpu_va); break;
        case 5: pandecode_abort_on_fault_v5(jc_gpu_va); break;
        case 6: pandecode_abort_on_fault_v6(jc_gpu_va); break;
        case 7: pandecode_abort_on_fault_v7(jc_gpu_va); break;
        case 9: pandecode_abort_on_fault_v9(jc_gpu_va); break;
        default: unreachable("Unsupported architecture");
        }

        simple_mtx_unlock(&pandecode_lock);
}

void pandecode_jc_v4(mali_ptr jc_gpu_va, unsigned gpu_id);
void pandecode_jc_v5(mali_ptr jc_gpu_va, unsigned gpu_id);
void pandecode_jc_v6(mali_ptr jc_gpu_va, unsigned gpu_id);
void pandecode_jc_v7(mali_ptr jc_gpu_va, unsigned gpu_id);
void pandecode_jc_v9(mali_ptr jc_gpu_va, unsigned gpu_id);

void
pandecode_jc(mali_ptr jc_gpu_va, unsigned gpu_id)
{
        simple_mtx_lock(&pandecode_lock);

        switch (pan_arch(gpu_id)) {
        case 4: pandecode_jc_v4(jc_gpu_va, gpu_id); break;
        case 5: pandecode_jc_v5(jc_gpu_va, gpu_id); break;
        case 6: pandecode_jc_v6(jc_gpu_va, gpu_id); break;
        case 7: pandecode_jc_v7(jc_gpu_va, gpu_id); break;
        case 9: pandecode_jc_v9(jc_gpu_va, gpu_id); break;
        default: unreachable("Unsupported architecture");
        }

        simple_mtx_unlock(&pandecode_lock);
}