MEdgeGrblDevice.cpp

/*
** Copyright (C) 2022 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-09-22T19:00:04
** Author: Sylvain Fargier <sylvain.fargier@cern.ch>
*/
 
#include "MEdgeGrblDevice.hpp"
 
#include <chrono>
#include <cstdlib>
 
#include <ccut/Regex.hpp>
#include <ccut/utils.hpp>
#include <logger/Logger.hpp>
 
#include "Exception.hpp"
#include "util/grbl/MGrblParser.hpp"
 
using namespace logger;
using namespace std::chrono;
 
static const ccut::Regex s_grblInit("^CMGrbl.*$");
 
namespace edge {
 
MEdgeGrblDevice::MEdgeGrblDevice(int lun, const std::string &driverPath)
{
    setenv("GRBL_SIM_INSTANCES", "8", 1);
    init(lun, driverPath);
    const std::string cmd = mgrbl::ControlSymbol +
        mgrbl::gen::Control::GrblCount;
    if (send(
            cmd,
            [&cmd](const std::string &msg) {
                notice(loggerCat) << "<--(init) " << msg;
                if (s_grblInit.search(msg))
                    throw grbl::ErrorCode{0};
                else if (ccut::startsWith(msg, cmd))
                    return true;
                return true;
            },
            milliseconds{5000}) != grbl::ErrorCode{0})
    {
        error(loggerCat) << "MGrbl initialization failed";
        throw smc::Exception{smc::ErrorCode::InternalError,
                             std::string{"Failed to get Grbl banner"}};
    }
}
 
} // namespace edge