 /* String formatting aSub subroutines
 *----------------------------------------------------------------------------*/

#include <algorithm>  // remove()
#include <iostream>
#include <sstream>
#include <string>
#include <vector>
#include <cstring>
#include <registryFunction.h>
#include <aSubRecord.h>
#include <epicsExport.h>

#define NUM_VALS 8

static const int debug = 0;

void removeChars(std::string &str, const char* chars) {
    for (int i = 0; chars[i]; ++i) {
        str.erase(remove(str.begin(), str.end(), chars[i]), str.end());
    }
}

template <typename T>
std::string join(const T& v, char delim) {
    std::ostringstream os;
    for (int i = 0; i < v.size(); i++) {
        if (i != 0) {
            os << delim;
        }
        os << v[i];
    }
    return os.str();
}

std::vector<std::string> splitIntoChunks(const std::string& str, char delim, size_t chunk_size) {
    std::string token;
    std::string chunk;
    std::stringstream ss(str);
    std::vector<std::string> token_vec;
    std::vector<std::string> chunk_vec;
    ss >> std::ws;
    while (getline(ss, token, delim)) {
        token_vec.push_back(token);
        if (token_vec.size() == chunk_size) {
            chunk = join(token_vec, delim);
            chunk_vec.push_back(chunk);
            token_vec.clear();
        }

        ss >> std::ws;
    }

    if (!token_vec.empty()) {
        chunk = join(token_vec, delim);
        chunk_vec.push_back(chunk);
    }

    return chunk_vec;
}

static long asQuotedStrToDouble(aSubRecord *pr) {
    std::string str = static_cast<char*>(pr->a);
    double* out = static_cast<double*>(pr->vala);

    if (str.empty()) return -1;
    if (debug) std::cout << str << " --> ";
    // Remove all double-quote characters
    removeChars(str, "\"");
    *out = strtod(str.c_str(), NULL);
    if (debug) std::cout << str << " --> " << *out << std::endl;
    return 0;
}

static long asQuotedStrToStr(aSubRecord *pr) {
    std::string str = static_cast<char*>(pr->a);

    if (debug) std::cout << str << " --> ";
    // Remove all double-quote characters
    removeChars(str, "\"");
    if (debug) std::cout << str << std::endl;
    pr->vala = static_cast<void*>(&str[0]);
    return 0;
}

static long splitStr(aSubRecord *pr) {
    std::string str = static_cast<char*>(pr->a);
    char delim = *static_cast<char*>(pr->b);
    size_t chunk_size = static_cast<size_t>(*static_cast<unsigned short*>(pr->c));

    if (!delim || chunk_size <= 0)
        return -1;

    if (debug) std::cout << str << " --> " << std::endl;
    // Remove all double-quote characters
    removeChars(str, "\"");
    std::vector<std::string> chunk_vec = splitIntoChunks(str, delim, chunk_size);
    for (size_t i = 0; i < chunk_vec.size(); i++) {
        if (i >= NUM_VALS)
            return -1;

        if (debug) std::cout << i + 1 << ": " << chunk_vec[i] << std::endl;
        char* p_curr_val_field = static_cast<char*>((&pr->vala)[i]);
        strncpy(p_curr_val_field, chunk_vec[i].c_str(), MAX_STRING_SIZE - 1);
        p_curr_val_field[MAX_STRING_SIZE - 1] = 0;
    }

    return 0;
}

epicsRegisterFunction(asQuotedStrToDouble);
epicsRegisterFunction(asQuotedStrToStr);
epicsRegisterFunction(splitStr);

