// %flair:license{
// This file is part of the Flair framework distributed under the
// CECILL-C License, Version 1.0.
// %flair:license}
//  created:    2014/04/25
//  filename:   Unix_SerialPort.cpp
//
//  author:     Guillaume Sanahuja
//              Copyright Heudiasyc UMR UTC/CNRS 7253
//
//  version:    $Id: $
//
//  purpose:    Class for unix serial port
//
//
/*********************************************************************/

#include "Unix_SerialPort.h"
#include <fcntl.h>   /* File control definitions */
#include <unistd.h>

using std::string;

namespace flair
{
namespace core
{

Unix_SerialPort::Unix_SerialPort(const Object* parent,string name,string device) : SerialPort(parent,name)
{
    //open port
	fd = open(device.c_str(), O_RDWR | O_NOCTTY);// |O_NDELAY|O_NONBLOCK);
	if (fd == -1)
	{
		Err("open_port: Unable to open %s\n",device.c_str());
	}
	//fcntl(fd, F_SETFL, 0); //read calls are non blocking

	//Get the current options for the port

	tcgetattr(fd, &options);
	//Set the baud rates to 115200
	cfsetispeed(&options, B115200);
	cfsetospeed(&options, B115200);

	options.c_cflag |= (CLOCAL | CREAD); //Enable the receiver and set local mode
	options.c_iflag = 0; //clear input options
	options.c_lflag=0; //clear local options
	options.c_oflag &= ~OPOST; //clear output options (raw output)

	//Set the new options for the port
    options.c_cc[VTIME] = 0;
    options.c_cc[VMIN] = 1;
	FlushInput();
	tcsetattr(fd, TCSANOW, &options);
}

Unix_SerialPort::~Unix_SerialPort()
{
    close(fd);
}

void Unix_SerialPort::SetBaudrate(int baudrate)
{
    //set port options
	struct termios options;
	//Get the current options for the port
	tcgetattr(fd, &options);
	//Set the baud rates to 115200

	switch(baudrate)
	{
	    case 1200:
            cfsetispeed(&options, B1200);
            cfsetospeed(&options, B1200);
            break;
        case 2400:
            cfsetispeed(&options, B2400);
            cfsetospeed(&options, B2400);
            break;
        case 4800:
            cfsetispeed(&options, B4800);
            cfsetospeed(&options, B4800);
            break;
        case 9600:
            cfsetispeed(&options, B9600);
            cfsetospeed(&options, B9600);
            break;
        case 19200:
            cfsetispeed(&options, B19200);
            cfsetospeed(&options, B19200);
            break;
        case 38400:
            cfsetispeed(&options, B38400);
            cfsetospeed(&options, B38400);
            break;
        case 115200:
            cfsetispeed(&options, B115200);
            cfsetospeed(&options, B115200);
            break;
        case 460800:
            cfsetispeed(&options, B460800);
            cfsetospeed(&options, B460800);
            break;
        case 921600:
            cfsetispeed(&options, B921600);
            cfsetospeed(&options, B921600);
            break;
        default:
            Err("unsupported baudrate\n");
	}
	tcsetattr(fd, TCSANOW, &options);
	FlushInput();

}

void Unix_SerialPort::SetRxTimeout(core::Time timeout_ns)
{

}

void Unix_SerialPort::FlushInput(void)
{
    tcflush(fd, TCIFLUSH);
}

ssize_t Unix_SerialPort::Write(const void *buf,size_t nbyte)
{
    return write(fd, buf, nbyte);
}

ssize_t Unix_SerialPort::Read(void *buf,size_t nbyte)
{
    if(options.c_cc[VMIN] != nbyte)
    {
        tcgetattr(fd, &options);//bug if not called?
        options.c_cc[VTIME] = 0;
        options.c_cc[VMIN] = nbyte;
        tcsetattr(fd, TCSANOW, &options);
    }

    return read(fd, buf, nbyte);
}

} // end namespace core
} // end namespace flair