/**

 * Spacenav Simulator Qt

 * Copyright © 2019 František Kučera (Frantovo.cz, GlobalCode.info)

 *

 * 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 3 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, see <http://www.gnu.org/licenses/>.

 */

#include <iostream>

#include "SimulatorSocketServer.h"

#include "ButtonEvent.h"

#include "MotionEvent.h"

enum SocketEventType : int32_t {

	Motion,

	ButtonPress,

	ButtonRelease

};

SimulatorSocketServer::SimulatorSocketServer() {

	QString path = "/tmp/spacenav-simulator.sock";

	bool listnening = server->listen(path);

	if (listnening) {

		std::wcout << L"Listening on: " << path.toStdWString() << std::endl;

		connect(server, &QLocalServer::newConnection, [path, this]() {

			std::wcout << L"New connection on: " << path.toStdWString() << std::endl;

			connections.push_back(server->nextPendingConnection());

		});

	} else {

		std::wcout << L"Unable to listen on: " << path.toStdWString() << std::endl; // TODO: throw exception

	}

}

SimulatorSocketServer::SimulatorSocketServer(const SimulatorSocketServer& orig) {

}

SimulatorSocketServer::~SimulatorSocketServer() {

}

void SimulatorSocketServer::publishButtonEvent(const ButtonEvent e) {

	std::array<int32_t, 8> data = {0};

	data[0] = e.pressed ? SocketEventType::ButtonPress : SocketEventType::ButtonRelease;

	data[1] = e.number;

	publish(data);

}

void SimulatorSocketServer::publishMotionEvent(const MotionEvent e) {

	std::array<int32_t, 8> data = {0};

	int i = 0;

	data[i++] = SocketEventType::Motion;

	data[i++] = e.x;

	data[i++] = e.y;

	data[i++] = e.z;

	data[i++] = e.rx;

	data[i++] = e.ry;

	data[i++] = e.rz;

	data[i++] = e.period;

	publish(data);

	// TODO: custom sensitivity for each connection

}

void SimulatorSocketServer::publish(const std::array<int32_t, 8> &data) {

	for (QLocalSocket* socket : connections) {

		if (socket->isValid()) {

			socket->write((char*) &data, sizeof data);

			socket->flush();

		} else {

			// TODO: remove invalid socket

		}

	}

}