ServerCommandLoco.cxx

Go to the documentation of this file.

 
#include "withrottle/ServerCommandLoco.hxx"
 
#include <cstdio>
 
#include "openlcb/TractionDefs.hxx"
#include "withrottle/Server.hxx"
 
namespace withrottle
{
 
/*
 * ServerCommandLoco::ServerCommandLoco()
 */
ServerCommandLoco::ServerCommandLoco(ThrottleFlow *throttle)
    : ServerCommandBase(throttle, PRIMARY)
{
    throttle->dispatcher.register_handler(this, SECONDARY, TYPE_MASK);
    throttle->dispatcher.register_handler(this, MULTI, TYPE_MASK);
}
 
/*
 * ServerCommandLoco::ServerCommandLoco()
 */
ServerCommandLoco::~ServerCommandLoco()
{
    throttle->dispatcher.unregister_handler(this, SECONDARY, TYPE_MASK);
    throttle->dispatcher.unregister_handler(this, MULTI, TYPE_MASK);
}
 
/*
 * ServerCommandLoco::entry()
 */
StateFlowBase::Action ServerCommandLoco::entry()
{
    switch (message()->data()->commandSubType)
    {
        default:
            return release_and_exit();
        case ADDR_LONG:
            return call_immediately(STATE(address_long));
    }
}
 
/*
 * ServerCommandLoco::address_long()
 */
StateFlowBase::Action ServerCommandLoco::address_long()
{
    unsigned long value = strtoul(message()->data()->payload.c_str(), NULL, 0);
 
    if ((value == 0 && errno == EINVAL) || value > 9999)
    {
        return release_and_exit();
    }
 
    printf("loco: %lu\n", value);
 
    openlcb::NodeID node_id = openlcb::TractionDefs::train_node_id_from_legacy(
        dcc::TrainAddressType::DCC_LONG_ADDRESS, value);
 
    return invoke_subflow_and_wait(&throttle->olcbThrottle, STATE(assign_train),
        openlcb::TractionThrottleCommands::ASSIGN_TRAIN, node_id, 0);
}
 
/*
 * ServerCommandLoco::assign_train()
 */
StateFlowBase::Action ServerCommandLoco::assign_train()
{
    auto *m = full_allocation_result(&throttle->olcbThrottle);
    switch (m->data()->resultCode)
    {
        //case openlcb::Defs::ERROR_CODE_OK:
        //    break;
        //case openlcb::Defs::ERROR_TIMEOUT:
        //case openlcb::Defs::ERROR_REJECTED:
        default:
            break;
    }
    m->unref();
 
    return invoke_subflow_and_wait(&throttle->olcbThrottle, STATE(load_state), 
                   openlcb::TractionThrottleCommands::LOAD_STATE);
}
 
/*
 * ServerCommandLoco::load_state()
 */
StateFlowBase::Action ServerCommandLoco::load_state()
{
    auto *m = full_allocation_result(&throttle->olcbThrottle);
    m->unref();
 
    string status = Defs::get_loco_status_string(&throttle->olcbThrottle,
                                                 message()->data()->train.c_str());
 
    ::write(throttle->fd, status.c_str(), status.length());
    printf("%s", status.c_str());
 
    return release_and_exit();
}
 
} /* namespace withrottle */