#include <cutter.h>
#include <pthread.h>
#include <signal.h>
#include <unistd.h>

#include "nfc/nfc.h"

#define INITIATOR 0
#define TARGET    1

pthread_t threads[2];
nfc_device_desc_t device_descriptions[2];
nfc_device_t *devices[2];
intptr_t result[2];

void
abort_test_by_keypress (int sig)
{
  (void) sig;
  printf ("\033[0;1;31mSIGINT\033[0m");

  nfc_abort_command (devices[INITIATOR]);
  nfc_abort_command (devices[TARGET]);
}

void
cut_setup (void)
{
  size_t n;

  nfc_list_devices (device_descriptions, 2, &n);
  if (n < 2) {
    cut_omit ("At least two NFC devices must be plugged-in to run this test");
  }

  devices[TARGET] = nfc_connect (&device_descriptions[TARGET]);
  devices[INITIATOR] = nfc_connect (&device_descriptions[INITIATOR]);

  signal (SIGINT, abort_test_by_keypress);
}

void
cut_teardown (void)
{
  nfc_disconnect (devices[TARGET]);
  nfc_disconnect (devices[INITIATOR]);
}

struct thread_data {
  nfc_device_t *device;
  void *cut_test_context;
};

void *
target_thread (void *arg)
{
  intptr_t thread_res = 0;
//  nfc_device_t *device = ((struct thread_data *) arg)->device;
  cut_set_current_test_context (((struct thread_data *) arg)->cut_test_context);

#if 0
  nfc_target_t nt = {
    .nm = {
      .nmt = NMT_DEP,
      .nbr = NBR_UNDEFINED
    },
    .nti = {
      .ndi = {
        .abtNFCID3 = { 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88, 0x99, 0xAA },
        .szGB = 4,
        .abtGB = { 0x12, 0x34, 0x56, 0x78 },
        .ndm = NDM_UNDEFINED,
        /* These bytes are not used by nfc_target_init: the chip will provide them automatically to the initiator */
        .btDID = 0x00,
        .btBS = 0x00,
        .btBR = 0x00,
        .btTO = 0x00,
        .btPP = 0x01,
      },
    },
  };

  byte_t abtRx[1024];
  size_t szRx = sizeof (abtRx);
  bool res = nfc_target_init (device, &nt, abtRx, &szRx);
  // cut_assert_true (res, cut_message ("Can't initialize NFC device as target"));

  byte_t abtAtrRes[] = "\x11\xd4\x00\x01\xfe\x12\x34\x56\x78\x90\x12\x00\x00\x00\x00\x00\x00";
  // cut_assert_equal_memory (abtAtrRes, sizeof (abtAtrRes) - 1, abtRx, szRx, cut_message ("Invalid received ATR_RES"));

  res = nfc_target_receive_bytes (device, abtRx, &szRx);
  // cut_assert_true (res, cut_message ("Can't receive bytes from initiator"));

  byte_t abtAttRx[] = "Hello DEP target!";
  // cut_assert_equal_memory (abtAttRx, sizeof (abtAttRx), abtRx, szRx, cut_message ("Invalid received data"));
  
  byte_t abtTx[] = "Hello DEP initiator!";
  res = nfc_target_send_bytes (device, abtTx, sizeof(abtTx));
  // cut_assert_true (res, cut_message ("Can't send bytes to initiator"));
#endif

  return (void *) thread_res;
}

void *
initiator_thread (void *arg)
{
  intptr_t thread_res = 0;
//  nfc_device_t *device = ((struct thread_data *) arg)->device;
  cut_set_current_test_context (((struct thread_data *) arg)->cut_test_context);

  cut_fail("plop");

#if 0
  /*
   * Wait some time for the other thread to initialise NFC device as target
   */
  sleep (1);
  printf ("====================================\n");
  printf ("Activating initiator...\n");

  bool res = nfc_initiator_init (device);
  // cut_assert_true (res, cut_message ("Can't initialize NFC device as initiator"));

  nfc_target_t nt;

  // Passive mode / 212Kbps
  res = nfc_initiator_select_dep_target (device, NDM_PASSIVE, NBR_212, NULL, &nt);
  // cut_assert_true (res, cut_message ("Can't select any DEP target"));
  // cut_assert_equal_int (NMT_DEP, nt.nm.nmt, cut_message ("Invalid target modulation"));
  // cut_assert_equal_int (NBR_212, nt.nm.nbr, cut_message ("Invalid target baud rate"));
  // cut_assert_equal_memory ("\x11\x22\x33\x44\x55\x66\x77\x88\x99\xAA", 10, nt.nti.ndi.abtNFCID3, 10, cut_message ("Invalid target NFCID3"));
  // cut_assert_equal_int (NDM_PASSIVE, nt.nti.ndi.ndm, cut_message ("Invalid target DEP mode"));
  // cut_assert_equal_memory ("\x12\x34\x56\x78", 4, nt.nti.ndi.abtGB, nt.nti.ndi.szGB, cut_message ("Invalid target general bytes"));

  byte_t abtTx[] = "Hello DEP target!";
  byte_t abtRx[1024];
  size_t szRx = sizeof (abtRx);
  res = nfc_initiator_transceive_bytes (device, abtTx, sizeof (abtTx), abtRx, &szRx);
  // cut_assert_true (res, cut_message ("Can't transceive bytes to target"));

  byte_t abtAttRx[] = "Hello DEP initiator!";
  // cut_assert_equal_memory (abtAttRx, sizeof (abtAttRx), abtRx, szRx, cut_message ("Invalid received data"));

  res = nfc_initiator_deselect_target (device);
  // cut_assert_true (res, cut_message ("Can't deselect target"));
#endif
  return (void *) thread_res;
}

void
test_dep (void)
{
  int res;

  CutTestContext *test_context = cut_get_current_test_context ();
  struct thread_data target_data = {
    .device = devices[TARGET],
    .cut_test_context = test_context,
  };
  if ((res = pthread_create (&(threads[TARGET]), NULL, target_thread, &target_data)))
    cut_fail ("pthread_create() returned %d", res);

  struct thread_data initiator_data = {
    .device = devices[INITIATOR],
    .cut_test_context = test_context,
  };
  if ((res = pthread_create (&(threads[INITIATOR]), NULL, initiator_thread, &initiator_data)))
    cut_fail ("pthread_create() returned %d", res);

  if ((res = pthread_join (threads[INITIATOR], (void *) &result[INITIATOR])))
    cut_fail ("pthread_join() returned %d", res);
  if ((res = pthread_join (threads[TARGET], (void *) &result[TARGET])))
    cut_fail ("pthread_join() returned %d", res);

  cut_assert_equal_int (0, result[INITIATOR], cut_message ("Unexpected initiator return code"));
  cut_assert_equal_int (0, result[TARGET], cut_message ("Unexpected target return code"));
}