/*
* Copyright 1993, 1994, 1995, Silicon Graphics, Inc.
* ALL RIGHTS RESERVED
*
* This source code ("Source Code") was originally derived from a
* code base owned by Silicon Graphics, Inc. ("SGI")
*
* LICENSE: SGI grants the user ("Licensee") permission to reproduce,
* distribute, and create derivative works from this Source Code,
* provided that: (1) the user reproduces this entire notice within
* both source and binary format redistributions and any accompanying
* materials such as documentation in printed or electronic format;
* (2) the Source Code is not to be used, or ported or modified for
* use, except in conjunction with OpenGL Performer; and (3) the
* names of Silicon Graphics, Inc. and SGI may not be used in any
* advertising or publicity relating to the Source Code without the
* prior written permission of SGI. No further license or permission
* may be inferred or deemed or construed to exist with regard to the
* Source Code or the code base of which it forms a part. All rights
* not expressly granted are reserved.
*
* This Source Code is provided to Licensee AS IS, without any
* warranty of any kind, either express, implied, or statutory,
* including, but not limited to, any warranty that the Source Code
* will conform to specifications, any implied warranties of
* merchantability, fitness for a particular purpose, and freedom
* from infringement, and any warranty that the documentation will
* conform to the program, or any warranty that the Source Code will
* be error free.
*
* IN NO EVENT WILL SGI BE LIABLE FOR ANY DAMAGES, INCLUDING, BUT NOT
* LIMITED TO DIRECT, INDIRECT, SPECIAL OR CONSEQUENTIAL DAMAGES,
* ARISING OUT OF, RESULTING FROM, OR IN ANY WAY CONNECTED WITH THE
* SOURCE CODE, WHETHER OR NOT BASED UPON WARRANTY, CONTRACT, TORT OR
* OTHERWISE, WHETHER OR NOT INJURY WAS SUSTAINED BY PERSONS OR
* PROPERTY OR OTHERWISE, AND WHETHER OR NOT LOSS WAS SUSTAINED FROM,
* OR AROSE OUT OF USE OR RESULTS FROM USE OF, OR LACK OF ABILITY TO
* USE, THE SOURCE CODE.
*
* Contact information: Silicon Graphics, Inc.,
* 1600 Amphitheatre Pkwy, Mountain View, CA 94043,
* or: http://www.sgi.com
*/
/*
* file: pfiFly.C
* ----------------------
*
* pfiFly motion model class routines
*
* $Revision: 1.1 $
* $Date: 2000/11/21 21:39:35 $
*
*/
#include <math.h>
#include <stdlib.h>
#include <Performer/prmath.h>
#define _PFI_XFORMER_C_
#include <Performer/pfui.h>
#include <Performer/pfui/pfiInputXform.h>
#include <Performer/pfui/pfiFly.h>
/******************************************************************************
* Fly Xformer Routines
******************************************************************************
*/
pfType *pfiInputXformFly::classType = NULL;
void
pfiInputXformFly::init()
{
if (classType == NULL)
{
pfiInputXformTravel::init();
classType =
new pfType(pfiInputXformTravel::getClassType(), "pfiInputXformFly");
}
}
pfiInputXformFly::pfiInputXformFly(void)
{
setType(classType);
xPitchMode = PFIXFLY_PITCH_FOLLOW;
xMotionCoord.startSpeed = 15.0f;
xMotionCoord.maxSpeed = 200.0f;
xMotionCoord.angularVel = 180.0f;
xMotionCoord.startAccel = xMotionCoord.accel = 2.0f;
xMotionCoord.maxAccel = 50.0f;
}
void
pfiInputXformFly::_setBSphere(pfSphere* _sphere)
{
xDBSphere = *_sphere;
xDBSize = 2.0f * xDBSphere.radius;
xDBSizeLg = logf(xDBSize);
if (!(xUserSetMask & _PFIX_USET_RESET_POS))
{
PFCOPY_VEC3(xMotionCoord.startPos.xyz, xDBSphere.center);
xMotionCoord.startPos.xyz[1] -= xDBSize*1.5f;
xMotionCoord.startPos.xyz[2] += xDBSphere.radius*0.5f;
PFSET_VEC3(xMotionCoord.startPos.hpr, 0.0f, 0.0f, 0.0f);
}
if (!(xUserSetMask & _PFIX_USET_START_MOTION))
{
xMotionCoord.startAccel = xMotionCoord.accel = PF_MAX2(5.0f, xDBSize*0.006f);
}
if (!(xUserSetMask & _PFIX_USET_MOTION_LIMITS))
{
xMotionCoord.maxSpeed = PF_MAX2(200.0f, xDBSize*5.0f);
if (xMotionCoord.minSpeed < 0.0f)
xMotionCoord.minSpeed = -xMotionCoord.maxSpeed;
xMotionCoord.maxAccel = xDBSize*2.0f;
if (xMotionCoord.minAccel < 0.0f)
xMotionCoord.minAccel = -xMotionCoord.maxAccel;
}
}
void
pfiInputXformFly::setMode(int _mode, int _val)
{
switch(_mode)
{
case PFIXFLY_MODE_MOTION:
if (xMotionMode == _val)
return;
if (!xInMotion)
xMotionCoord.speed = xMotionCoord.startSpeed;
xMotionMode = _val;
break;
case PFIXFLY_MODE_MOTION_MOD:
xMotionMod = _val;
break;
case PFIXFLY_MODE_ACCEL:
if (xAccelMode != _val)
{
xAccelMode = _val;
xMotionCoord.accel = 0;
}
break;
case PFIXFLY_MODE_AUTO:
xAuto = _val;
break;
case PFIXFLY_MODE_PITCH:
xPitchMode = _val;
break;
default:
pfNotify(PFNFY_WARN,PFNFY_USAGE,
"pfiInputXformFly::setMode() - unknown mode %d", _mode);
break;
}
}
int
pfiInputXformFly::getMode(int _mode) const
{
switch(_mode)
{
case PFIXFLY_MODE_MOTION:
return xMotionMode;
case PFIXFLY_MODE_MOTION_MOD:
return xMotionMod;
case PFIXFLY_MODE_ACCEL:
return xAccelMode;
case PFIXFLY_MODE_PITCH:
return xPitchMode;
case PFIXFLY_MODE_AUTO:
return xAuto;
default:
pfNotify(PFNFY_WARN,PFNFY_USAGE,
"pfi2DInputXformFly::getMode() - unknown mode %d", _mode);
return -1;
}
}
int
pfiUpdate2DIXformFly(pfiInputXform *_ix, pfiInputCoord *_ic, void *)
{
pfiInputXformFly *_fly = (pfiInputXformFly *)_ix;
pfi2DInputCoord *_icoord = (pfi2DInputCoord *)_ic;
float deltaTime;
float cosHeading;
float sinHeading;
float cosPitch;
float sinPitch;
float x, y;
if (_fly->xUpdateMode != PFI_CB_CONT)
return _fly->xUpdateMode;
if (_fly->xMotionMode == PFIXFLY_MOTION_STOP)
{
_fly->stop();
_fly->xAccelMode = PFIXFLY_ACCEL_NONE;
}
else
{
float absSpeed = PF_ABS(_fly->xMotionCoord.speed);
float distance=0.0f;
deltaTime = _fly->xMotionCoord.time - _fly->xMotionCoord.prevTime;
if ((absSpeed < 1e-10))
{
absSpeed = _fly->xMotionCoord.speed = 0.0f;
}
if (_fly->xInMotion)
{
/* determine new acceleration and speed */
switch (_fly->xAccelMode)
{
case PFIXFLY_ACCEL_INCREASE:
if (_fly->xMotionCoord.accel <= _fly->xMotionCoord.startAccel)
_fly->xMotionCoord.accel = _fly->xMotionCoord.startAccel;
_fly->xMotionCoord.accel += _fly->xAccelRate * deltaTime;
break;
case PFIXFLY_ACCEL_DECREASE:
if (_fly->xMotionCoord.accel >= -_fly->xMotionCoord.startAccel)
_fly->xMotionCoord.accel = -_fly->xMotionCoord.startAccel;
_fly->xMotionCoord.accel -= _fly->xAccelRate * deltaTime;
break;
case PFIXFLY_ACCEL_NONE:
_fly->xMotionCoord.accel = 0.0f;
break;
}
_fly->xMotionCoord.speed += _fly->xMotionCoord.accel * deltaTime;
_fly->limitSpeed();
}
/* Apply quadratic-scaling to create deadened center */
x = 0.5f - _icoord->getCoord(PF_X);
x *= PF_ABS(x);
y = 0.5f - _icoord->getCoord(PF_Y);
y *= PF_ABS(y);
if (_fly->xPitchMode == PFIXFLY_PITCH_FLIGHT)
{
pfMatrix &m = _fly->xMotionCoord.mat;
m.preRot(x*_fly->xMotionCoord.angularVel*deltaTime, 0.0, -1.0, 0.0,m);
m.preRot(y*_fly->xMotionCoord.angularVel*deltaTime*0.75, 1.0, 0.0, 0.0,m);
switch(_fly->xMotionMode)
{
case PFIXFLY_MOTION_HP:
if (_fly->xInMotion)
{
_fly->xInMotion = 0;
_fly->pfiInputXform::stop();
}
break;
case PFIXFLY_MOTION_FORWARD:
case PFIXFLY_MOTION_REVERSE:
_fly->xMotionCoord.mat.preTrans(0.0,_fly->xMotionCoord.speed * deltaTime, 0.0,m);
_fly->xInMotion = 1;
break;
}
m.getOrthoCoord(&_fly->xMotionCoord.pos);
}
else
{
if (!(_fly->xMotionMod & PFIXFLY_MOTION_MOD_VERTICAL))
{
/* Mouse x steers vehicle */
_fly->xMotionCoord.pos.hpr[0] += x * _fly->xMotionCoord.angularVel * deltaTime;
if (_fly->xPitchMode == PFIXFLY_PITCH_FLIGHT)
_fly->xMotionCoord.pos.hpr[1] += y * _fly->xMotionCoord.angularVel * deltaTime;
else
_fly->xMotionCoord.pos.hpr[1] -= y * _fly->xMotionCoord.angularVel * deltaTime;
if (absSpeed > 0.0f)
{
pfSinCos(_fly->xMotionCoord.pos.hpr[0], &sinHeading, &cosHeading);
pfSinCos(_fly->xMotionCoord.pos.hpr[1], &sinPitch, &cosPitch);
distance = _fly->xMotionCoord.speed * deltaTime;
}
}
_fly->xMotionCoord.pos.hpr[2] *= 0.9f;
extern float _PFI_FUDGE; // XXX
if (_PFI_FUDGE < 0)
{
char *e = getenv("_PFI_FUDGE");
_PFI_FUDGE = (e ? *e ? atof(e) : .1 : 1);
}
switch(_fly->xMotionMode)
{
case PFIXFLY_MOTION_HP:
if (_fly->xInMotion)
{
_fly->xInMotion = 0;
_fly->pfiInputXform::stop();
}
break;
case PFIXFLY_MOTION_FORWARD:
if (absSpeed > 0.0f)
{
_fly->xMotionCoord.pos.xyz[PF_X] -= distance * cosPitch * sinHeading * _PFI_FUDGE;
_fly->xMotionCoord.pos.xyz[PF_Y] += distance * cosPitch * cosHeading * _PFI_FUDGE;
_fly->xMotionCoord.pos.xyz[PF_Z] += distance * sinPitch * _PFI_FUDGE;
}
_fly->xInMotion = 1;
break;
case PFIXFLY_MOTION_REVERSE:
if (absSpeed > 0.0f)
{
_fly->xMotionCoord.pos.xyz[PF_X] += distance * cosPitch * sinHeading * _PFI_FUDGE;
_fly->xMotionCoord.pos.xyz[PF_Y] -= distance * cosPitch * cosHeading * _PFI_FUDGE;
_fly->xMotionCoord.pos.xyz[PF_Z] -= distance * sinPitch * _PFI_FUDGE;
}
_fly->xInMotion = 1;
break;
}
}
// additional motion modifiers
if (_fly->xMotionMod & PFIXFLY_MOTION_MOD_VERTICAL)
{
if (_fly->getFocus())
{
float y = 0.5f - _icoord->getCoord(PF_Y);
y *= PF_ABS(y);
_fly->xMotionCoord.pos.xyz[PF_Z] -= y * _fly->xDBSize * deltaTime;
}
}
}
_fly->xMotionCoord.makeMat();
return PFI_CB_CONT;
}
pfiInputXformFly *
pfiCreate2DIXformFly(void *arena)
{
pfiInputXformFly *fly;
fly = new(arena) pfiInputXformFly;
fly->setInputCoordPtr(new(arena) pfi2DInputCoord);
fly->setUpdateFunc(pfiUpdate2DIXformFly, NULL);
return fly;
}