BodyInfo_impl.h

Go to the documentation of this file.

/*
 * Copyright (c) 2008, AIST, the University of Tokyo and General Robotix Inc.
 * All rights reserved. This program is made available under the terms of the
 * Eclipse Public License v1.0 which accompanies this distribution, and is
 * available at http://www.eclipse.org/legal/epl-v10.html
 * Contributors:
 * National Institute of Advanced Industrial Science and Technology (AIST)
 */
 
#ifndef OPENHRP_MODEL_LOADER_BODYINFO_IMPL_H_INCLUDED
#define OPENHRP_MODEL_LOADER_BODYINFO_IMPL_H_INCLUDED
 
#include <string>
#include <hrpCorba/ORBwrap.h>
#include <hrpCorba/ModelLoader.hh>
#include <hrpModel/ModelNodeSet.h>
#include <hrpCollision/ColdetModel.h>
 
#include "ShapeSetInfo_impl.h"
 
using namespace OpenHRP;
using namespace hrp;
 
class BodyInfo_impl :
    public virtual POA_OpenHRP::BodyInfo,
    public virtual ShapeSetInfo_impl
{
  public:
                
    BodyInfo_impl(PortableServer::POA_ptr poa);
    virtual ~BodyInfo_impl();
 
    virtual char* name();
    virtual char* url();
    virtual StringSequence* info();
    virtual LinkInfoSequence* links();
    virtual AllLinkShapeIndexSequence* linkShapeIndices();
        virtual ExtraJointInfoSequence* extraJoints();
 
    void loadModelFile(const std::string& filename);
 
    void setLastUpdateTime(time_t time) { lastUpdate_ = time;};
    time_t getLastUpdateTime() { return lastUpdate_; }
    bool checkInlineFileUpdateTime() { return checkFileUpdateTime(); }
 
    bool getParam(std::string param);
    void setParam(std::string param, bool value);
    void setParam(std::string param, int value);
    void changetoBoundingBox(unsigned int* depth) ; 
    void changetoOriginData();
 
protected:
 
    virtual const std::string& topUrl();
 
private:
        
    time_t lastUpdate_;
    bool readImage_;
    OpenHRP::ModelLoader::AABBdataType AABBdataType_;
 
    std::string name_;
    std::string url_;
    StringSequence info_;
    LinkInfoSequence links_;
    AllLinkShapeIndexSequence linkShapeIndices_;
    AllLinkShapeIndexSequence originlinkShapeIndices_;
        ExtraJointInfoSequence extraJoints_;
 
    std::vector<ColdetModelPtr> linkColdetModels;
 
    int readJointNodeSet(JointNodeSetPtr jointNodeSet, int& currentIndex, int motherIndex);
    void setJointParameters(int linkInfoIndex, VrmlProtoInstancePtr jointNode );
    void setSegmentParameters(int linkInfoIndex, JointNodeSetPtr jointNodeSet);
    void setSensors(int linkInfoIndex, JointNodeSetPtr jointNodeSet);
    void setHwcs(int linkInfoIndex, JointNodeSetPtr jointNodeSet);
    void setLights(int linkInfoIndex, JointNodeSetPtr jointNodeSet);
    void readSensorNode(int linkInfoIndex, SensorInfo& sensorInfo, VrmlProtoInstancePtr sensorNode);
    void readHwcNode(int linkInfoIndex, HwcInfo& hwcInfo, VrmlProtoInstancePtr hwcNode);
    void readLightNode(int linkInfoIndex, LightInfo& LightInfo, 
                       std::pair<Matrix44, VrmlNodePtr> &transformedLight);
};
 
#endif