fixed: compile issue

[opensg.git] / Source / System / Window / Utilities / OSGWalkEngine.cpp

/*---------------------------------------------------------------------------*\
 *                                OpenSG                                     *
 *                                                                           *
 *                                                                           *
 *             Copyright (C) 2000-2002 by the OpenSG Forum                   *
 *                                                                           *
 *                            www.opensg.org                                 *
 *                                                                           *
 *   contact: dirk@opensg.org, gerrit.voss@vossg.org, jbehr@zgdv.de          *
 *                                                                           *
\*---------------------------------------------------------------------------*/
/*---------------------------------------------------------------------------*\
 *                                License                                    *
 *                                                                           *
 * This library is free software; you can redistribute it and/or modify it   *
 * under the terms of the GNU Library General Public License as published    *
 * by the Free Software Foundation, version 2.                               *
 *                                                                           *
 * This library 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         *
 * Library General Public License for more details.                          *
 *                                                                           *
 * You should have received a copy of the GNU Library General Public         *
 * License along with this library; if not, write to the Free Software       *
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.                 *
 *                                                                           *
\*---------------------------------------------------------------------------*/
/*---------------------------------------------------------------------------*\
 *                                Changes                                    *
 *                                                                           *
 *                                                                           *
 *                                                                           *
 *                                                                           *
 *                                                                           *
 *                                                                           *
\*---------------------------------------------------------------------------*/

#include "OSGConfig.h"
#include "OSGBaseTypes.h"
#include "OSGMatrix.h"
#include "OSGMatrixUtility.h"

#include "OSGWalkEngine.h"
#include "OSGNavigator.h"
#include "OSGNode.h"
#include "OSGCamera.h"
#include "OSGBackground.h"

OSG_USING_NAMESPACE

/***************************************************************************\
 *                            Description                                  *
\***************************************************************************/

/*! \class OSG::WalkEngine
    \ingroup GrpSystemWindowNavigators

\dev 

\enddev

*/

WalkEngineTransitPtr
WalkEngine::create(void)
{
    return WalkEngineTransitPtr(new WalkEngine);
}

/*------------------------------ get --------------------------------------*/

/*------------------------------ set --------------------------------------*/

void WalkEngine::setGround(Node * const new_ground)
{
    _ground=new_ground;
}

void WalkEngine::setWorld(Node * const new_world)
{
    _world=new_world;
}

void WalkEngine::setGroundDistance(Real32 groundDistance)
{
    _groundDistance=groundDistance;
}

void WalkEngine::setMinWallDistance (Real32 wallDistance)
{
    _wallDistance=wallDistance;
}
    
void WalkEngine::setPersonDimensions(Real32 height,Real32 width,Real32 fatness)
{
    _height  = height;
    _width   = width;
    _fatness = fatness;
}

/*---------------------- navigator engine callbacks ------------------------*/
void WalkEngine::idle(Int16 buttons, Int16 x, Int16 y, Navigator* nav)
{
    if (buttons) moveTo(x, y, nav);
}

void WalkEngine::onViewportChanged(Navigator* nav)
{
    Viewport *vp = nav->getViewport();
    setGround(vp->getRoot());
    setWorld (vp->getRoot());
}

/*---------------------- Walker Transformations ----------------------------*/

/*! makes a rotation
 */

void WalkEngine::rotate (Real32 deltaX, Real32 deltaY)
{
    Inherited::rotate(deltaX, deltaY);
}
   
/*! "walks" forward
 */

Real32 WalkEngine::forward(Real32 step)
{
    Vec3f lv = _rFrom - _rAt;
    lv.normalize();

    Vec3f upn = _vUp;
    upn.normalize();

    Vec3f mv = lv - upn.dot(lv)*upn;
    mv.normalize();

    //side vector symbolizes shoulders
    Vec3f sv = mv;
    sv.crossThis(upn);
    sv.normalize();

    Pnt3f rFrom = _rFrom + step * mv;
    Pnt3f rAt   = _rAt   + step * mv;

    Real32 dist;
    Line line(rFrom, -upn);

    //keep the walker at a constant distance from the ground
    _act->setLine(line   );
    _act->apply  (_ground);

    if(_act->didHit())
    {
        dist = _act->getHitT();
        if(dist >= _height)
        {
            rFrom = rFrom + (_groundDistance - dist + _height) * upn;
            rAt   = rAt   + (_groundDistance - dist + _height) * upn;
        }
        else return 0.0f;    //can't jump so high
    }

    //finally check if the move is correct or not

    line.setValue(rFrom, (rFrom - _rFrom));
    _act->setLine(line  );
    _act->apply  (_world);

    if(_act->didHit())
    {
        dist = _act->getHitT();
        if(dist <= _fatness + _wallDistance)
            return 0.0;     //running against a wall
    }

    //move was ok, store new values
    _rFrom = rFrom;
    _rAt   = rAt;

    return step;
}

/*! turns the viewer right or left
 */

Real32 WalkEngine::right(Real32 step)
{
//    Int16 sign = (step >= 0) ? -1 : 1;
//    Real32 angle = 0.19634954f;
//
//    //rotate around the up vector
//    FlyNavigator::rotate(sign*angle, 0);
//    return step;

    Vec3f lv = _rFrom - _rAt;
    lv.normalize();

    Vec3f upn = _vUp;
    upn.normalize();

    Vec3f mv = lv - upn.dot(lv)*upn;
    mv.normalize();

    //side vector symbolizes shoulders
    Vec3f sv = mv;
    sv.crossThis(upn);
    sv.normalize();

    Pnt3f rFrom = _rFrom + step * sv;
    Pnt3f rAt   = _rAt   + step * sv;

    Real32 dist;
    Line line(rFrom, -upn);

    //keep the walker at a constant distance from the ground
    _act->setLine(line   );
    _act->apply  (_ground);

    if(_act->didHit())
    {
        dist = _act->getHitT();
        if(dist >= _height)
        {
            rFrom = rFrom + (_groundDistance - dist + _height) * upn;
            rAt   = rAt   + (_groundDistance - dist + _height) * upn;
        }
        else return 0.0;    //can't jump so high
    }

    //finally check if the move is correct or not

    line.setValue(rFrom, (rFrom - _rFrom));
    _act->setLine(line  );
    _act->apply  (_world);

    if(_act->didHit())
    {
        dist = _act->getHitT();
        if(dist <= _fatness + _wallDistance)
            return 0.0;     //running against a wall
    }

    //move was ok, store new values
    _rFrom = rFrom;
    _rAt   = rAt;

    return step;
}

/*------------------------- constructors ----------------------------------*/

WalkEngine::WalkEngine(void) : 
    Inherited(),
    _ground(NULL),
    _world(NULL),
    _groundDistance(0.75f),
    _wallDistance(0.1f),
    _height(0.85f),
    _width(0.5f),
    _fatness(0.5f),
    _act(IntersectAction::create())
{
}

/*-------------------------- destructors ----------------------------------*/

WalkEngine::~WalkEngine()
{
    _act = NULL;
}