SimpleNodeInfo.cxx

 
#include "openlcb/SimpleNodeInfo.hxx"
 
#include "openmrn_features.h"
#include "utils/format_utils.hxx"
 
namespace openlcb
{
 
extern const SimpleNodeStaticValues __attribute__((weak)) SNIP_STATIC_DATA = {
    4, "OpenMRN", "Undefined model", "Undefined HW version", "0.9"};
 
void init_snip_user_file(int fd, const char *user_name,
                         const char *user_description)
{
    ::lseek(fd, 0, SEEK_SET);
    SimpleNodeDynamicValues data;
    memset(&data, 0, sizeof(data));
    data.version = 2;
    str_populate(data.user_name, user_name);
    str_populate(data.user_description, user_description);
    int ofs = 0;
    auto *p = (const uint8_t *)&data;
    const int len = sizeof(data);
    while (ofs < len)
    {
        int ret = ::write(fd, p, len - ofs);
        if (ret < 0)
        {
            LOG(FATAL, "Init SNIP file: Could not write to fd %d: %s", fd,
                strerror(errno));
        }
        ofs += ret;
    }
}
 
static size_t find_string_at(const openlcb::Payload& payload, size_t start_pos, string* output) {
    if (start_pos >= payload.size()) {
        output->clear();
        return start_pos;
    }
    size_t epos = payload.find('\0', start_pos);
    output->assign(payload.substr(start_pos, epos - start_pos));
    if (epos == string::npos) {
        return epos;
    } else {
        return epos + 1;
    }
}
 
void decode_snip_response(
    const openlcb::Payload &payload, SnipDecodedData *output)
{
    output->clear();
    if (payload.empty())
    {
        return;
    }
    char sys_ver = payload[0];
    size_t pos = 1;
    pos = find_string_at(payload, pos, &output->manufacturer_name);
    pos = find_string_at(payload, pos, &output->model_name);
    pos = find_string_at(payload, pos, &output->hardware_version);
    pos = find_string_at(payload, pos, &output->software_version);
    // Future-proof with the version handling.
    for (int i = 4; i < sys_ver; ++i)
    {
        string discard;
        pos = find_string_at(payload, pos, &discard);
    }
    if (pos == string::npos)
    {
        return;
    }
    // char usr_ver = payload[pos];
    pos++;
    pos = find_string_at(payload, pos, &output->user_name);
    pos = find_string_at(payload, pos, &output->user_description);
}
 
} // namespace nrmanet