/**
* 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, version 3 of the License.
*
* 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;
std::wcout << L"To allow client connections do:" << std::endl;
std::wcout << L"ln -s " << path.toStdWString() << " /var/run/spnav.sock" << 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
}
}
}