#include <QCoreApplication>
#include <QDebug>
#include <QJsonDocument>
#include <QProcessEnvironment>
#include <QTimer>
#include <QVsoa>

constexpr char SERVER_INFO[] = "{\"name\":\"axis_server\"}";
constexpr char SERVER_PASSWORD[] = "123456";
constexpr char SERVER_ADDR[] = "0.0.0.0";
constexpr int SERVER_PORT = 3002;

using namespace std::placeholders;

void onNewClient(QPointer<QVsoaCliHandle> client)
{
    qDebug() << QStringLiteral("New client, address: %1:%2").arg(client->address().ip()).arg(client->address().port());
}

void onDisconnected(QPointer<QVsoaCliHandle> client)
{
    qDebug() << QStringLiteral("Client disconnect: %1:%2").arg(client->address().ip()).arg(client->address().port());
}

static int roll = 1;
static int pitch = 1;
static int yaw = 1;
void publishMessage(QVsoaServer *server)
{
    if (server->isSubscribed("/axis")) {
        QVariantMap param = {
            {"poll",  roll++ },
            {"pitch", pitch++},
            {"yaw",   yaw++  }
        };
        // Publish /axis
        server->publish("/axis", QVsoaPayload(QString::fromUtf8(QJsonDocument::fromVariant(param).toJson()), {}));
    }
}

int main(int argc, char *argv[])
{
    QCoreApplication a(argc, argv);

    // Initialize server
    QVsoaServer server(SERVER_INFO);
    if (server.isInvalid()) {
        qDebug() << "Can not create VSOA server!";
        return -1;
    }

    // If need password
    server.setPassword(SERVER_PASSWORD);

    QObject::connect(&server, &QVsoaServer::newClient, onNewClient);
    QObject::connect(&server, &QVsoaServer::clientDisconnect, onDisconnected);

    int port = SERVER_PORT;
    int auto_port = QProcessEnvironment::systemEnvironment().value("VSOA_AUTO_PORT", "-1").toInt();
    if (auto_port != -1) {
        port = auto_port;
    }
    // Start server
    if (!server.start(QVsoaSocketAddress(AF_INET, SERVER_ADDR, port))) {
        qDebug() << "Can not start VSOA server!";
        return -1;
    }
    qDebug() << "Started VSOA server.";

    QTimer timer;
    QObject::connect(&timer, &QTimer::timeout, std::bind(publishMessage, &server));
    timer.start(1000);

    return a.exec();
}

server->publish("/axis", QVsoaPayload(QString::fromUtf8(QJsonDocument::fromVariant(param).toJson()), {}), true);