#include <unistd.h>
#include <stdio.h>
#include <mosquitto.h>
#include <string.h>
#include <unistd.h>

#include "mqtt.h"
#include "config.h"

#define MAX_AIRSPEED 385
#define MAX_MQTT_PAYLOAD_SIZE 512

struct mosquitto *mqtt;

int airspeed = 0;
int heading = 0;

struct test {
	char *foo;
};

void onMessage(struct mosquitto *mqtt, void *obj, const struct mosquitto_message *message) {
	char *mqttTopic;
	char mqttPayload[MAX_MQTT_PAYLOAD_SIZE];

	if (strcmp(message->topic, "/xplane/meta/rref") == 0) {
		//requestRrefFromXPlane(message);
	} else if (strcmp(message->topic, "/xplane/meta/cmnd") == 0) {
		mqttTopic = NULL;
		memset(mqttPayload, 0, sizeof(mqttPayload));

		printf("CMD: %s\n", (char *)message->payload);
		if (strcmp((char *)message->payload, "sim/autopilot/airspeed_up") == 0) {
			airspeed++;
			if (airspeed > MAX_AIRSPEED) {
				airspeed = MAX_AIRSPEED;
			} else {
				// airspeed changed
				mqttTopic = "/xplane/rref/2";
				sprintf(mqttPayload, "%03d", airspeed);
			}
			printf("Airspeed: %d\n", airspeed);
		} else if (strcmp((char *)message->payload, "sim/autopilot/airspeed_down") == 0) {
			airspeed--;
			if (airspeed < 0) {
				airspeed = 0;
			} else {
				mqttTopic = "/xplane/rref/2";
				sprintf(mqttPayload, "%03d", airspeed);
			}
			printf("Airspeed: %d\n", airspeed);
		} else if (strcmp((char *)message->payload, "sim/autopilot/heading_up") == 0) {
			heading++;
			if (heading > 360) {
				heading = 1;
			}
			mqttTopic = "/xplane/rref/1";
			sprintf(mqttPayload, "%03d", heading);
			printf("Heading: %d\n", heading);
		} else if (strcmp((char *)message->payload, "sim/autopilot/heading_down") == 0) {
			heading--;
			if (heading < 0) {
				heading = 359;
			}
			mqttTopic = "/xplane/rref/1";
			sprintf(mqttPayload, "%03d", heading);
			printf("Heading: %d\n", heading);
		} else {
			printf("unkown command %s\n", (char *)message->payload);
		}

		if (mqttTopic != NULL && mqttPayload != NULL) {
			sendMqtt(mqtt, mqttTopic, mqttPayload, strlen(mqttPayload));
		}
	} else if (strcmp(message->topic, "/xplane/meta/log") == 0) {
		printf("Log: %s\n", (char *)message->payload);
	} else {
		fprintf(stderr, "Unknown topic %s\n", message->topic);
	}
}

void doit(struct test *blah) {
	blah->foo = "moep";
}

int main() {
	struct test bar = { "baz" };
	doit(&bar);
	printf("foo is %s\n", bar.foo);

	mqtt = connectMqtt(MQTT_USER1, MQTT_PASS, onMessage);
	if (mqtt == NULL) {
		return -1;
	}

	recvMqtt(mqtt, "/xplane/meta/cmnd");

	while (1) {
		mosquitto_loop(mqtt, 0, 1);
		usleep(10 * 1000);
	}

	disconnectMqtt(mqtt);
}