#include "helper.h"
#include "fsfw/serviceinterface.h"

#include <sys/ioctl.h>

void uart::setMode(struct termios& options, UartModes mode) {
  if (mode == UartModes::NON_CANONICAL) {
    /* Disable canonical mode */
    options.c_lflag &= ~ICANON;
  } else if (mode == UartModes::CANONICAL) {
    options.c_lflag |= ICANON;
  }
}

void uart::setBaudrate(struct termios& options, UartBaudRate baud) {
  switch (baud) {
    case UartBaudRate::RATE_50:
      cfsetispeed(&options, B50);
      cfsetospeed(&options, B50);
      break;
    case UartBaudRate::RATE_75:
      cfsetispeed(&options, B75);
      cfsetospeed(&options, B75);
      break;
    case UartBaudRate::RATE_110:
      cfsetispeed(&options, B110);
      cfsetospeed(&options, B110);
      break;
    case UartBaudRate::RATE_134:
      cfsetispeed(&options, B134);
      cfsetospeed(&options, B134);
      break;
    case UartBaudRate::RATE_150:
      cfsetispeed(&options, B150);
      cfsetospeed(&options, B150);
      break;
    case UartBaudRate::RATE_200:
      cfsetispeed(&options, B200);
      cfsetospeed(&options, B200);
      break;
    case UartBaudRate::RATE_300:
      cfsetispeed(&options, B300);
      cfsetospeed(&options, B300);
      break;
    case UartBaudRate::RATE_600:
      cfsetispeed(&options, B600);
      cfsetospeed(&options, B600);
      break;
    case UartBaudRate::RATE_1200:
      cfsetispeed(&options, B1200);
      cfsetospeed(&options, B1200);
      break;
    case UartBaudRate::RATE_1800:
      cfsetispeed(&options, B1800);
      cfsetospeed(&options, B1800);
      break;
    case UartBaudRate::RATE_2400:
      cfsetispeed(&options, B2400);
      cfsetospeed(&options, B2400);
      break;
    case UartBaudRate::RATE_4800:
      cfsetispeed(&options, B4800);
      cfsetospeed(&options, B4800);
      break;
    case UartBaudRate::RATE_9600:
      cfsetispeed(&options, B9600);
      cfsetospeed(&options, B9600);
      break;
    case UartBaudRate::RATE_19200:
      cfsetispeed(&options, B19200);
      cfsetospeed(&options, B19200);
      break;
    case UartBaudRate::RATE_38400:
      cfsetispeed(&options, B38400);
      cfsetospeed(&options, B38400);
      break;
    case UartBaudRate::RATE_57600:
      cfsetispeed(&options, B57600);
      cfsetospeed(&options, B57600);
      break;
    case UartBaudRate::RATE_115200:
      cfsetispeed(&options, B115200);
      cfsetospeed(&options, B115200);
      break;
    case UartBaudRate::RATE_230400:
      cfsetispeed(&options, B230400);
      cfsetospeed(&options, B230400);
      break;
#ifndef __APPLE__
    case UartBaudRate::RATE_460800:
      cfsetispeed(&options, B460800);
      cfsetospeed(&options, B460800);
      break;
    case UartBaudRate::RATE_500000:
      cfsetispeed(&options, B500000);
      cfsetospeed(&options, B500000);
      break;
    case UartBaudRate::RATE_576000:
      cfsetispeed(&options, B576000);
      cfsetospeed(&options, B576000);
      break;
    case UartBaudRate::RATE_921600:
      cfsetispeed(&options, B921600);
      cfsetospeed(&options, B921600);
      break;
    case UartBaudRate::RATE_1000000:
      cfsetispeed(&options, B1000000);
      cfsetospeed(&options, B1000000);
      break;
    case UartBaudRate::RATE_1152000:
      cfsetispeed(&options, B1152000);
      cfsetospeed(&options, B1152000);
      break;
    case UartBaudRate::RATE_1500000:
      cfsetispeed(&options, B1500000);
      cfsetospeed(&options, B1500000);
      break;
    case UartBaudRate::RATE_2000000:
      cfsetispeed(&options, B2000000);
      cfsetospeed(&options, B2000000);
      break;
    case UartBaudRate::RATE_2500000:
      cfsetispeed(&options, B2500000);
      cfsetospeed(&options, B2500000);
      break;
    case UartBaudRate::RATE_3000000:
      cfsetispeed(&options, B3000000);
      cfsetospeed(&options, B3000000);
      break;
    case UartBaudRate::RATE_3500000:
      cfsetispeed(&options, B3500000);
      cfsetospeed(&options, B3500000);
      break;
    case UartBaudRate::RATE_4000000:
      cfsetispeed(&options, B4000000);
      cfsetospeed(&options, B4000000);
      break;
#endif  // ! __APPLE__
    default:
#if FSFW_CPP_OSTREAM_ENABLED == 1
      sif::warning << "UartComIF::configureBaudrate: Baudrate not supported" << std::endl;
#endif
      break;
  }
}

int uart::readCountersAndErrors(int serialPort, serial_icounter_struct& icounter) {
   return ioctl(serialPort, TIOCGICOUNT, &icounter);
}