#include "lwip/sio.h"
#include <arpa/inet.h>
#include <cstring>
#include <lwip/ip_addr.h>
#include <lwip/tcpip.h>
#include <netif/slipif.h>
#include <sys/socket.h>

#include <xuartps.h>

extern "C" {
void myInitDone(void *arg) {
  puts("init done");

  puts("socket");

  int serverSocket = socket(AF_INET, SOCK_DGRAM, 0);
  if (serverSocket == -1) {
    puts("socket failed");
    return;
  }

  sockaddr_in serverAddr;

  memset(&serverAddr, 0, sizeof(serverAddr));

  serverAddr.sin_family = AF_INET6;
  serverAddr.sin_port = htons(0xcafe);
  serverAddr.sin_addr.s_addr = inet_addr("10.0.0.13");

  uint8_t data[] = {1, 2, 3, 4, 5, 6, 7};

  puts("send");

  sendto(serverSocket, data, sizeof(data), 0, (sockaddr *)&serverAddr,
         sizeof(serverAddr));
}
}

sio_fd_t sio_open(u8_t devnum) { return 0; }

void sio_send(u8_t c, sio_fd_t fd) { XUartPs_SendByte(STDOUT_BASEADDRESS, c); }

void testIp() {
  struct netif netif;

  tcpip_init(myInitDone, nullptr);

  ip_addr_t slip_addr = IPADDR4_INIT_BYTES(10, 0, 0, 32),
            slip_mask = IPADDR4_INIT_BYTES(255, 255, 255, 0),
            slip_gw = IPADDR4_INIT_BYTES(255, 255, 255, 0);

  netif_add(&netif, &slip_addr.u_addr.ip4, &slip_mask.u_addr.ip4,
            &slip_gw.u_addr.ip4, NULL, slipif_init, netif_input);

  netif_set_default(&netif);
  netif_set_up(&netif);
}