MGrblParser.cpp

/*
** Copyright (C) 2021 CERN
**
** This software is provided 'as-is', without any express or implied
** warranty.  In no event will the authors be held liable for any damages
** arising from the use of this software.
**
** Permission is granted to anyone to use this software for any purpose,
** including commercial applications, and to alter it and redistribute it
** freely, subject to the following restrictions:
**
** 1. The origin of this software must not be misrepresented; you must not
**    claim that you wrote the original software. If you use this software
**    in a product, an acknowledgment in the product documentation would be
**    appreciated but is not required.
** 2. Altered source versions must be plainly marked as such, and must not be
**    misrepresented as being the original software.
** 3. This notice may not be removed or altered from any source distribution.
**
** Created on: 2022-04-29T15:44:12+02:00
**     Author: Sylvain Fargier <sfargier> <sylvain.fargier@cern.ch>
**
*/
 
#include "MGrblParser.hpp"
 
#include <ccut/utils.hpp>
#include <logger/Logger.hpp>
 
#include "Exception.hpp"
 
using namespace smc;
using namespace logger;
 
namespace mgrbl {
 
namespace gen {
const std::string Control::Layout = "$layout";
const std::string Control::GrblCount = "$grblCount";
const std::string Control::TrigArm = "$trigArm";
const std::string Control::TrigSoft = "$trigSoft";
const std::string Control::BuildInfo = "$I";
} // namespace gen
 
static const std::string s_loggerCat{"mgrbl:parser"};
 
bool MGrblParser::parseLayout(const std::string &line, Layout &layout)
{
    if (!ccut::startsWith(line, gen::Control::Layout) ||
        line[gen::Control::Layout.size()] != '=')
    {
        error(s_loggerCat) << "invalid layout";
        return false;
    }
 
    std::size_t end(line.find_first_of("\r\n", 8));
    const std::string value(
        line.substr(8, (end == std::string::npos) ? end : (end - 8)));
    layout.reserve(value.size());
    for (const char c : value)
        layout.emplace_back(c - '0');
    return true;
}
 
bool MGrblParser::parseIsArmed(const std::string &line, bool &isArmed)
{
    if (!ccut::startsWith(line, gen::Control::TrigArm) ||
        line[gen::Control::TrigArm.size()] != '=')
    {
        return false;
    }
 
    const std::string value(line.substr(9, 1));
    if (value == "1")
        isArmed = true;
    else if (value == "0")
        isArmed = false;
    else
        throw Exception(smc::ErrorCode::InvalidArguments,
                        "invalid isArmed response value");
 
    return true;
}
 
} // namespace mgrbl