mhoff / ros_music_adapter Goto Github PK

    // [...]
    port_out = initOutput("out", width_);
    // TODO MUSIC bug ...
    port_out_polarity[true] = NULL; // initOutput("out_on", width_);
    port_out_polarity[false] = NULL; // initOutput("out_off", width_);
}

MUSIC::EventOutputPort* DVSAdapter::initOutput(std::string name, int &width)
{
    MUSIC::EventOutputPort* port = setup->publishEventOutput(name);
    if (port->isConnected())
    {
        if (not port->hasWidth())
        {
            std::cout << "ERROR: port " << name << " has no width" << std::endl;
            comm.Abort(2);
        }

        int width_ = port->width();
        if (width != -1 and width_ != width)
        {
            std::cout << "ERROR: node has inconsistent output widths (" << width << " != " << width_ << ")" << std::endl;
            comm.Abort(3);
        }
        width = width_;

        // map linear index to event out port
        MUSIC::LinearIndex l_index_out(0, width_);
        port->map(&l_index_out, MUSIC::Index::GLOBAL, 1);
    }
    else
    {
        port = NULL;
    }
    return port;
}