/*
 * 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 <assert.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/mman.h>

#include "util/macros.h"
#include "util/simple_mtx.h"
#include "util/u_debug.h"
#include "util/u_dynarray.h"
#include "decode.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;

#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(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(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);
}
