FakeGPIO.cpp

Go to the documentation of this file.

/*
    Copyright (C) 2014-2016 Leosac

    This file is part of Leosac.

    Leosac is free software: you can redistribute it and/or modify
    it under the terms of the GNU Affero General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    Leosac is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
    GNU Affero General Public License for more details.

    You should have received a copy of the GNU Affero General Public License
    along with this program. If not, see <http://www.gnu.org/licenses/>.
*/

#include "FakeGPIO.hpp"

using namespace Leosac::Test::Helper;

FakeGPIO::FakeGPIO(zmqpp::context &ctx, const std::string &name)
    : ctx_(ctx)
    , name_(name)
    , push_(ctx, zmqpp::socket_type::push)
    , rep_(ctx, zmqpp::socket_type::rep)
    , value_(false)
{
    push_.connect("inproc://zmq-bus-pull");
    rep_.bind("inproc://" + name);
}

void FakeGPIO::interrupt()
{
    push_.send("S_INT:" + name_);
}

bool FakeGPIO::run(zmqpp::socket *pipe)
{
    zmqpp::poller poller;

    poller.add(*pipe);
    poller.add(rep_);

    pipe->send(zmqpp::signal::ok);

    while (true)
    {
        poller.poll(-1);
        if (poller.has_input(*pipe))
            break;

        if (poller.has_input(rep_))
        {
            handle_cmd();
        }
    }
    return true;
}

void FakeGPIO::handle_cmd()
{
    zmqpp::message_t msg;
    std::string frame1;
    rep_.receive(msg);

    msg >> frame1;
    if (frame1 == "ON")
        value_ = true;
    else if (frame1 == "OFF")
        value_ = false;
    else if (frame1 == "TOGGLE")
        value_ = !value_;
    else if (frame1 == "STATE")
        return send_state();
    else
        assert(0);

    push_.send(zmqpp::message() << ("S_" + name_) << (value_ ? "ON" : "OFF"));
    rep_.send("OK");
}

void FakeGPIO::send_state()
{
    rep_.send((value_ ? "ON" : "OFF"));
}