// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.

#include "BufferCallbackStore.hpp"

#include <jni.h>

#include <cstdio>
#include <memory>

#include "SimulatorJNI.hpp"
#include "wpi/hal/Types.h"
#include "wpi/hal/handles/UnlimitedHandleResource.hpp"
#include "wpi/util/jni_util.hpp"

using namespace wpi::hal;
using namespace wpi::hal::sim;
using namespace wpi::util::java;

static wpi::hal::UnlimitedHandleResource<
    SIM_JniHandle, BufferCallbackStore,
    wpi::hal::HAL_HandleEnum::SIMULATION_JNI>* callbackHandles;

namespace wpi::hal::sim {
void InitializeBufferStore() {
  static wpi::hal::UnlimitedHandleResource<
      SIM_JniHandle, BufferCallbackStore,
      wpi::hal::HAL_HandleEnum::SIMULATION_JNI>
      cb;
  callbackHandles = &cb;
}
}  // namespace wpi::hal::sim

void BufferCallbackStore::create(JNIEnv* env, jobject obj) {
  m_call = JGlobal<jobject>(env, obj);
}

void BufferCallbackStore::performCallback(const char* name, uint8_t* buffer,
                                          uint32_t length) {
  JNIEnv* env;
  JavaVM* vm = sim::GetJVM();
  bool didAttachThread = false;
  int tryGetEnv = vm->GetEnv(reinterpret_cast<void**>(&env), JNI_VERSION_1_6);
  if (tryGetEnv == JNI_EDETACHED) {
    // Thread not attached
    didAttachThread = true;
    if (vm->AttachCurrentThread(reinterpret_cast<void**>(&env), nullptr) != 0) {
      // Failed to attach, log and return
      std::puts("Failed to attach");
      std::fflush(stdout);
      return;
    }
  } else if (tryGetEnv == JNI_EVERSION) {
    std::puts("Invalid JVM Version requested");
    std::fflush(stdout);
  }

  auto toCallbackArr =
      MakeJByteArray(env, {buffer, static_cast<size_t>(length)});

  env->CallVoidMethod(m_call, sim::GetBufferCallback(), MakeJString(env, name),
                      toCallbackArr, static_cast<jint>(length));

  jbyte* fromCallbackArr = reinterpret_cast<jbyte*>(
      env->GetPrimitiveArrayCritical(toCallbackArr, nullptr));

  for (size_t i = 0; i < length; i++) {
    buffer[i] = fromCallbackArr[i];
  }

  env->ReleasePrimitiveArrayCritical(toCallbackArr, fromCallbackArr, JNI_ABORT);

  if (env->ExceptionCheck()) {
    env->ExceptionDescribe();
  }

  if (didAttachThread) {
    vm->DetachCurrentThread();
  }
}

void BufferCallbackStore::free(JNIEnv* env) {
  m_call.free(env);
}

SIM_JniHandle sim::AllocateBufferCallback(
    JNIEnv* env, jint index, jobject callback,
    RegisterBufferCallbackFunc createCallback) {
  auto callbackStore = std::make_shared<BufferCallbackStore>();

  auto handle = callbackHandles->Allocate(callbackStore);

  if (handle == HAL_INVALID_HANDLE) {
    return -1;
  }

  uintptr_t handleAsPtr = static_cast<uintptr_t>(handle);
  void* handleAsVoidPtr = reinterpret_cast<void*>(handleAsPtr);

  callbackStore->create(env, callback);

  auto callbackFunc = [](const char* name, void* param, uint8_t* buffer,
                         uint32_t length) {
    uintptr_t handleTmp = reinterpret_cast<uintptr_t>(param);
    SIM_JniHandle handle = static_cast<SIM_JniHandle>(handleTmp);
    auto data = callbackHandles->Get(handle);
    if (!data) {
      return;
    }

    data->performCallback(name, buffer, length);
  };

  auto id = createCallback(index, callbackFunc, handleAsVoidPtr);

  callbackStore->setCallbackId(id);

  return handle;
}

void sim::FreeBufferCallback(JNIEnv* env, SIM_JniHandle handle, jint index,
                             FreeBufferCallbackFunc freeCallback) {
  auto callback = callbackHandles->Free(handle);
  if (callback == nullptr) {
    return;
  }
  freeCallback(index, callback->getCallbackId());
  callback->free(env);
}
