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"));
}