DeviceDriver.cpp

Go to the documentation of this file.

/*
 * Copyright (C) 2006-2020 Istituto Italiano di Tecnologia (IIT)
 * Copyright (C) 2006-2010 RobotCub Consortium
 * All rights reserved.
 *
 * This software may be modified and distributed under the terms of the
 * BSD-3-Clause license. See the accompanying LICENSE file for details.
 */
 
#include <cstdio>
#include <yarp/dev/DeviceDriver.h>
#include <yarp/os/Vocab.h>
#include <yarp/os/Value.h>
 
using namespace yarp::dev;
using namespace yarp::os;
using namespace yarp::os::impl;
 
 
 
DeviceResponder::DeviceResponder() {
    makeUsage();
}
 
void DeviceResponder::addUsage(const char *txt, const char *explain) {
    examples.addString(txt); //Value::makeList(txt));
    explains.addString((explain!=nullptr)?explain:"");
    details.add(Value::makeList(txt));
    std::string more = std::string("   ") + ((explain != nullptr) ? explain : "");
    details.addString(more.c_str());
}
 
 
void DeviceResponder::addUsage(const Bottle& bot, const char *explain) {
    addUsage(bot.toString().c_str(),explain);
}
 
 
bool DeviceResponder::respond(const Bottle& command, Bottle& reply) {
    switch (command.get(0).asVocab()) {
    case yarp::os::createVocab('h','e','l','p'):
        if (examples.size()>=1) {
            reply.add(Value::makeVocab("many"));
            if (command.get(1).toString()=="more") {
                reply.append(details);
            } else {
                reply.append(examples);
            }
            return true;
        } else {
            reply.addString("no documentation available");
            return false;
        }
        break;
    default:
        reply.addString("command not recognized");
        return false;
    }
    return false;
}
 
bool DeviceResponder::read(ConnectionReader& connection) {
    Bottle cmd, response;
    if (!cmd.read(connection)) { return false; }
    //printf("command received: %s\n", cmd.toString().c_str());
    respond(cmd,response);
    if (response.size()>=1) {
        ConnectionWriter *writer = connection.getWriter();
        if (writer!=nullptr) {
            if (response.get(0).toString()=="many"&&writer->isTextMode()) {
                for (size_t i=1; i<response.size(); i++) {
                    Value& v = response.get(i);
                    if (v.isList()) {
                        v.asList()->write(*writer);
                    } else {
                        Bottle b;
                        b.add(v);
                        b.write(*writer);
                    }
                }
            } else {
                response.write(*writer);
            }
 
            //printf("response sent: %s\n", response.toString().c_str());
        }
    } else {
        ConnectionWriter *writer = connection.getWriter();
        if (writer!=nullptr) {
            response.clear();
            response.addVocab(Vocab::encode("nak"));
            response.write(*writer);
        }
    }
    return true;
}
 
 
void DeviceResponder::makeUsage() {
    examples.clear();
    explains.clear();
    details.clear();
    addUsage("[help]", "list usage");
    addUsage("[help] [more]", "list usage with some comments");
}