#ifndef COMMAND_MESSAGE_H
#define COMMAND_MESSAGE_H

#include "Component.h"
#include <Vector.h>
#include <ArduinoLog.h>
#include <StringUtils.h>

// CommandMessage struct:<< id,verb,flags,payload[ID:METHOD:ARG1:ARG2] >>
// Example :<<1;2;0;1:foo:1:2>>

// <<1;2;64;1:printRegisters:1:0>>

#ifdef DEBUG_MESSAGES_PARSE
#define DEBUG_MESSAGES_PARSER(format, ...) Log.verboseln(format, ##__VA_ARGS__)
#else
#define DEBUG_MESSAGES_PARSER(format, ...)
#endif

class CommandMessage
{
public:
    short id;
    E_CALLS verb;
    E_MessageFlags flags;
    uchar version;
    const char *payload;
    millis_t ts;

    static constexpr char *START_STR = C_STR("<<");
    static constexpr char *END_STR = C_STR(">>");
    static constexpr char *DELIMITER = C_STR(";");

    static constexpr int START_LENGTH = 2;
    static constexpr int END_LENGTH = 2;

    CommandMessage(short _id, E_CALLS _verb, E_MessageFlags _flags) : id(_id),
                                                        verb(_verb),
                                                        flags(_flags)
    {
    }

    void clear()
    {
        id = 0;
        verb = E_CALLS::EC_NONE;
        flags = E_MessageFlags::E_MF_NONE;
        payload = NULL;
        ts = 0;
    }

    bool matches(String string)
    {
        return string.startsWith(CommandMessage::START_STR) && string.endsWith(CommandMessage::END_STR);
    }

    bool parse(String message)
    {
        clear();
        String data = message.substring(CommandMessage::START_LENGTH, message.length() - CommandMessage::END_LENGTH);

        const char *strings[5];
        char *ptr = NULL;
        byte index = 0;
        ptr = strtok(C_STR(data.c_str()), CC_STR(CommandMessage::DELIMITER));
        const short MESSAGE_TOKENS = 4;

        while (ptr != NULL && index < MESSAGE_TOKENS)
        {
            strings[index] = ptr;
            index++;
            ptr = strtok(NULL, CC_STR(CommandMessage::DELIMITER));
        }

        if (index < MESSAGE_TOKENS)
        {
            DEBUG_MESSAGES_PARSER("CommandMessage::parse: invalid message - incomplete - got %d tokens", index);
            return false;
        }

        id = atoi(strings[0]);
        verb = (E_CALLS)convertTo<int>(strings[1]);
        flags = (E_MessageFlags)convertTo<long int>(strings[2]);
        // version = atoi(strings[3]);
        payload = strings[3];
        ts = millis();
        DEBUG_MESSAGES_PARSER("CommandMessage::parse: id: %d, verb: %d, flags: %d, payload: %s - tokens:%d", id, verb, flags, payload, index);
        return true;
    }
};

#endif