source/viewer/instructions/GetBodyPosition.cpp

Go to the documentation of this file.

/*
 * Copyright (c) 2007, 2008, 2009, University of Karlsruhe (for members see AUTHORS file)
 *
 * ISC License
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 *
 * Created by Alexander Bierbaum
 */

#include "../include/IPSA/ipsaclasses.h"
#include "../include/IPSA/viewer/instructions/GetBodyPosition.h"

#include <sstream>

Instruction::tExecResultType GetBodyPosition::vExecute(std::vector<std::string>& Instr, std::ostringstream& answer, unsigned int& numberOfReturnValues)
{
    numberOfReturnValues = 0;
                tExecResultType res = eBODY_NOT_FOUND;
                SoPhysics* phy = Instruction::GetNodeOfTypeByName<SoPhysics*>(Instr[1]);
                if (phy)
                {
                                SbVec3f position = phy->getCurrentPosition().getValue();
                                answer << std::scientific << position[0] << ' ' << position[1] << ' ' << position[2];
                                numberOfReturnValues = 3;
                                res = eOK;
                }
                else
                                res = eNODE_IS_NOT_A_BODY;

                answer  << '\r' << std::endl;
                return res;
}

---