MGrblDeviceWrapper.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-05-13
//     Author: Michal Mysior <mmysior> <michal.mysior@cern.ch>
//
 
#include "MGrblDeviceWrapper.hpp"
 
#include <logger/Logger.hpp>
 
using namespace logger;
 
namespace grbl {
 
static const std::string s_loggerCat{"smc:grbl:mgrbldevice"};
 
MGrblDeviceWrapper::MGrblDeviceWrapper(
    size_t instance,
    const std::shared_ptr<grbl::GrblDeviceBase> &device) :
    m_instance(instance),
    m_device(device)
{}
 
void MGrblDeviceWrapper::read()
{
    m_device->read();
}
void MGrblDeviceWrapper::write(const std::string &data)
{
    warning(s_loggerCat) << "raw write called on MGrblDeviceWrapper";
    m_device->write(data);
}
 
grbl::ErrorCode MGrblDeviceWrapper::send(
    const std::string &cmd,
    std::function<bool(const std::string &)> msg,
    const std::chrono::milliseconds &timeout)
{
    char id = static_cast<char>('0' + m_instance);
    if (bool(msg))
        return m_device->send(
            id + cmd,
            [this, msg, id](const std::string &line) {
                if (!line.empty() && line[0] == id)
                    return msg(line.substr(1));
                return false;
            },
            timeout);
    else
        return m_device->send(id + cmd, {}, timeout);
}
 
grbl::ErrorCode MGrblDeviceWrapper::sendRealtime(
    const std::string &cmd,
    std::function<bool(const std::string &)> msg,
    const std::chrono::milliseconds &timeout)
{
    char id = static_cast<char>('0' + m_instance);
    if (bool(msg))
        return m_device->sendRealtime(
            id + cmd,
            [this, msg, id](const std::string &line) {
                if (!line.empty() && line[0] == id)
                    return msg(line.substr(1));
                return false;
            },
            timeout);
    else
        return m_device->sendRealtime(id + cmd, {}, timeout);
}
 
bool MGrblDeviceWrapper::wait(const std::chrono::milliseconds &timeout)
{
    return m_device->wait(timeout);
}
 
void MGrblDeviceWrapper::wake()
{
    m_device->wake();
}
 
} // namespace grbl