rtai_out_elem.cc

Go to the documentation of this file.

/* $Header: /var/cvs/mbdyn/mbdyn/mbdyn-1.0/mbdyn/base/rtai_out_elem.cc,v 1.50 2017/01/12 14:46:10 masarati Exp $ */
/* 
 * MBDyn (C) is a multibody analysis code. 
 * http://www.mbdyn.org
 *
 * Copyright (C) 1996-2017
 *
 * Pierangelo Masarati  <masarati@aero.polimi.it>
 * Paolo Mantegazza     <mantegazza@aero.polimi.it>
 *
 * Dipartimento di Ingegneria Aerospaziale - Politecnico di Milano
 * via La Masa, 34 - 20156 Milano, Italy
 * http://www.aero.polimi.it
 *
 * Changing this copyright notice is forbidden.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation (version 2 of the License).
 * 
 *
 * This program 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 General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

/* socket driver */

#include "mbconfig.h"           /* This goes first in every *.c,*.cc file */

/* include del programma */

#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <netdb.h>

#include "rtai_out_elem.h"
#include "mbrtai_utils.h"
#include "dataman.h"

/* RTMBDynOutElem - begin */

RTMBDynOutElem::RTMBDynOutElem(unsigned int uL, const std::string& host,
        const std::string& m, unsigned long n, bool c, StreamContent *pSC,
        bool bNonBlocking)
: Elem(uL, flag(0)),
StreamOutElem(uL, m, 1),
host(host), node(n), create(c), port(-1),
bNonBlocking(bNonBlocking),
pSC(pSC),
mbx(0),
f_send(0)
{
        /* RATIONALE:
         *
         * if host/node is present, the mailbox is "remote";
         * if it not, we may need to create it
         */

        if (create) {
                ASSERT(node == 0);

                if (rtmbdyn_rt_mbx_init(name.c_str(), pSC->GetOutSize(), &mbx)) {
                        silent_cerr("RTMBDyn mailbox(" << name << ") "
                                "init failed" << std::endl);
                        throw ErrGeneric(MBDYN_EXCEPT_ARGS);
                }

        } else {
                if (node) {
                        /* get port ... */
                        port = rtmbdyn_rt_request_port(node);
                        /* FIXME: what in case of failure? */
                }

                if (rtmbdyn_RT_get_adr(node, port, name.c_str(), &mbx)) {
                        silent_cerr("RTMBDyn mailbox(" << name << ") "
                                "get_adr failed" << std::endl);
                        throw ErrGeneric(MBDYN_EXCEPT_ARGS);
                }
        }

        if (bNonBlocking) {
                f_send = rtmbdyn_RT_mbx_send_if;

        } else {
                f_send = rtmbdyn_RT_mbx_send;
        }
}

RTMBDynOutElem::~RTMBDynOutElem(void)
{
        if (mbx) {
                rtmbdyn_rt_mbx_delete(&mbx);
        }

        if (pSC) {
                SAFEDELETE(pSC);
        }
}

std::ostream&
RTMBDynOutElem::Restart(std::ostream& out) const
{
        return out << "# RTMBDynOutElem(" << GetLabel() << ") "
                "not implemented yet" << std::endl;
}

void
RTMBDynOutElem::AfterConvergence(const VectorHandler& X, 
                const VectorHandler& XP)
{
        pSC->Prepare();

        int rc = f_send(node, -port, mbx, (void *)pSC->GetOutBuf(), pSC->GetOutSize());
        if (rc != pSC->GetOutSize()) {
                /* FIXME: error */
        }
}

void
RTMBDynOutElem::AfterConvergence(const VectorHandler& X, 
                const VectorHandler& XP, const VectorHandler& XPP)
{
        AfterConvergence(X, XP);
}