//
//  PLP - An implementation of the PSION link protocol
//
//  Copyright (C) 1999  Philip Proudman
//
//  This program is free software; you can redistribute it and/or modify
//  it under the terms of the GNU General Public License as published by
//  the Free Software Foundation; either version 2 of the License, or
//  (at your option) any later version.
//
//  This program is distributed in the hope that it will be useful,
//  but WITHOUT ANY WARRANTY; without even the implied warranty of
//  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
//  GNU General Public License for more details.
//
//  You should have received a copy of the GNU General Public License
//  along with this program; if not, write to the Free Software
//  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
//
//  e-mail philip.proudman@btinternet.com

#include <unistd.h>
#include <stdio.h>
#include <sys/time.h>
#include <sys/types.h>
#include <stream.h>
#include <memory.h>

#include "bool.h"
#include "iowatch.h"

IOWatch::IOWatch() {
	num = 0;
	io = new int [FD_SETSIZE];
}

IOWatch::~IOWatch() {
	delete [] io;
}

void IOWatch::addIO(const int fd) {
	int pos;
	for (pos = 0; pos < num && fd < io[pos]; pos++);
	if (io[pos] == fd)
		return;
	for (int i = num; i > pos; i--)
		io[i] = io[i-1];
	io[pos] = fd;
	num++;
}

void IOWatch::remIO(const int fd) {
	int pos;
	for (pos = 0; pos < num && fd != io[pos]; pos++);
	if (pos != num) {
		num--;
		for (int i = pos; i <num; i++) io[i] = io[i+1];
	}
}

bool IOWatch::watch(const long secs, const long usecs) {
	if (num > 0) {
		fd_set iop;
		FD_ZERO(&iop);
		for (int i = 0; i < num; i++)
			FD_SET(io[i], &iop);
		struct timeval t;
		t.tv_usec = usecs;
		t.tv_sec = secs;
		return (select(io[0]+1, &iop, NULL, NULL, &t) > 0);
	}
	sleep(secs);
	usleep(usecs);
	return false;
}