#include "libfn.h"

#include <unistd.h>
#include <sys/ioctl.h>
#include <stdio.h>

struct termios fn_init(int fd) {
        struct termios oldtio, newtio;
        
        tcgetattr(fd, &oldtio); 	/* save current port settings */
        
        memset(&newtio, 0, sizeof(newtio));
        newtio.c_cflag = CS8 | CLOCAL | CREAD;
        newtio.c_iflag= 0;
        newtio.c_oflag= 0;
        newtio.c_lflag= 0;

        newtio.c_cc[VMIN] = 1;
        newtio.c_cc[VTIME] = 5;

	cfsetispeed(&newtio, FN_BAUDRATE);
	cfsetospeed(&newtio, FN_BAUDRATE);
         
        tcflush(fd, TCIFLUSH);
        tcsetattr(fd, TCSANOW, &newtio);

	fn_sync(fd);

	return oldtio;
}

size_t fn_send(int fd, struct remote_msg_t * msg) {
	return write(fd, msg, REMOTE_MSG_LEN);
}

/*size_t fn_send_mask(int mask, struct remote_msg_t * msg) {
	return 0;
}*/

size_t fn_sync(int fd) {
	uint8_t sync[REMOTE_SYNC_LEN+1];
	memset(sync, REMOTE_SYNC_BYTE, REMOTE_SYNC_LEN);
	sync[REMOTE_SYNC_LEN] = 0;	/* address byte */

	return write(fd, sync, REMOTE_SYNC_LEN+1);
}

uint8_t fn_count_devices(int fd) {
	struct remote_msg_pull_int_t msg;
	memset(&msg, 0, REMOTE_MSG_LEN);

	msg.address = 0;
	msg.cmd = REMOTE_CMD_PULL_INT;
	msg.delay = 1;

	while (1) {
		fn_send(fd, (struct remote_msg_t *) &msg);
		usleep(25000);

		if (fn_get_int(fd)) {
			msg.address++;
			usleep(25000);
		}
		else {
			break;
		}
	} 

	return msg.address;
}

int fn_get_int(int fd) {
	int i;
	ioctl (fd, TIOCMGET, &i);

	return i & FN_INT_LINE;
}