/*
 * challenge_com.c
 *
 *  Created on: 05.12.2022
 *      Author: jonas
 */

#include <stdbool.h>

#include "challenge_com.h"
#include "challenge_app.h"
#include "platform.h"
#include "esp_log.h"
#include "McuUtility.h"
#include "mjson.h"
#include "mqtt_client.h"
#include "myMqtt.h"
#include "splitflap_wrapper.h"

#define TAG "CHALLENGE_COM" /* tag for logging with ESP_LOG */

/* TOPICS */
const char MQTT_TOPIC_SF_DISPLAY[] = "/splitFlap/cmd/display/";
const char MQTT_TOPIC_SF_INITALL[] = "/splitFlap/cmd/init/";
const char MQTT_TOPIC_SF_CONFIG_SETUP[] = "/splitFlap/config/setup/";

void Challenge_Com_ParseMqtt(void *handler_args, esp_event_base_t base, int32_t event_id, void *event_data){
	/* INFO
	 * TOPIC: 			event->topic      ==> do not directly use, string is not limited
	 * TOPIC LENGTH: 	event->topic_len
	 * DATA: 			event->data       ==> do not directly use, string is not limited
	 * DATA LENGTH: 	event->data_len
	 * CLIENT: 			event->client
	 */

    esp_mqtt_event_handle_t event = event_data;
    // cut strings to length
    char topic[event->topic_len+1]; char data[event->data_len+1];
    McuUtility_strcpy((unsigned char*)topic, sizeof(topic), (unsigned char*)event->topic);
    McuUtility_strcpy((unsigned char*)data, sizeof(data), (unsigned char*)event->data);

    bool handled = false;

    // check if event id is MQTT_EVENT_DATA => break if not
    if((esp_mqtt_event_id_t)event_id != MQTT_EVENT_DATA) {
        ESP_LOGE(TAG, "Wrong data received. Can only handle MQTT_EVENT_DATA (event id %i). But received event id: %i", MQTT_EVENT_DATA, (esp_mqtt_event_id_t)event_id);
        return;
    }

    /* check topic and call related command if allowed by robot mode */
    /* stationary robot allowed commands */
    if(Challenge_App_GetRobotMode() == true) {
    	// CMD: CONFIG SETUP
        if(McuUtility_strcmp(topic, MQTT_TOPIC_SF_CONFIG_SETUP)==0){
        	handled = true;
        	// parse json
        	int setupId = 0;
        	int hwId = 0;
        	struct json_attr_t json_attrs[] = {
        	    {"setupId",    t_integer, .addr.integer = &setupId},
        	    {"hardwareId", t_integer, .addr.integer = &hwId,},
        	    {NULL},
        	};
        	int err = json_read_object(data, json_attrs, NULL);
        	if(err != 0){
        		ESP_LOGE(TAG, "Parsing JSON data of CONFIG SETUP message failed. Event data was = %s", data);
        		ESP_LOGE(TAG, "Parse error was: %s", json_error_string(err));
        	} else{  // successfully parsed
        		// check values
        		if(setupId >= 0 && setupId <= 10 && hwId >= 0 && hwId <= 50){
    				SplitFlap_Wrapper_SetHardwareIdentifier(setupId, hwId);
        		} else{
        			ESP_LOGE(TAG, "SetupID or HardwareID out of range. Event data was = %s", data);
        		}
        	}
        }
        // CMD: INIT ALL
        else if(McuUtility_strcmp(topic, MQTT_TOPIC_SF_INITALL)==0){
        	handled = true;
        	SplitFlap_Wrapper_MoveAllToZeroPosition();
        }
        // CMD: DISPLAY
        else if(McuUtility_strcmp(topic, MQTT_TOPIC_SF_DISPLAY)==0){
        	handled = true;
        	// parse json
        	char message[10] = "TEST";
        	struct json_attr_t json_attrs[] = {
				{"message", t_string, .addr.string = message, .len = sizeof(message)},
				{NULL},
			};
        	int err = json_read_object(data, json_attrs, NULL);
        	if(err != 0){
				ESP_LOGE(TAG, "Parsing JSON data of DISPLAY message failed. Event data was = %s", data);
				ESP_LOGE(TAG, "Parse error was: %s", json_error_string(err));
			} else{  // successfully parsed
	        	SplitFlap_Wrapper_Display((unsigned char*)message);
			}
        }
    }
    /* mobile robot allowed commands */
    else{

    }

    /* both robot modes allowed commands */



    if(handled == false){
        ESP_LOGE(TAG, "Received data could not be handled. Topic was %s", topic);
    }
    return;
}

void Challenge_Com_SubscribeToAllTopics(void){
	MyMqtt_Subscribe(MQTT_TOPIC_SF_INITALL);
	MyMqtt_Subscribe(MQTT_TOPIC_SF_DISPLAY);
	MyMqtt_Subscribe(MQTT_TOPIC_SF_CONFIG_SETUP);
}