prj/cam/src/physics/phystest.cpp

   1 /*
   2 @Copyright Looking Glass Studios, Inc.
   3 1996,1997,1998,1999,2000 Unpublished Work.
   4 */
   5
   6 ///////////////////////////////////////////////////////////////////////////////
   7 // $Header: r:/t2repos/thief2/src/physics/phystest.cpp,v 1.36 2000/02/19 12:32:29 toml Exp $
   8 //
   9 // Physics test code
  10 //
  11
  12 #ifndef SHIP
  13
  14 #include <stdlib.h>
  15
  16 #include <appagg.h>
  17
  18 #include <objtype.h>
  19 #include <osysbase.h>
  20 #include <iobjsys.h>
  21 #include <objpos.h>
  22 #include <objshape.h>
  23 #include <collprop.h>
  24 #include <config.h>
  25
  26 #include <playrobj.h>
  27 extern "C" {
  28 #include <camera.h>
  29 }
  30 #include <matrixs.h>
  31 #include <matrix.h>
  32 #include <portal.h>
  33
  34 #include <mnamprop.h>
  35
  36 #include <phystest.h>
  37 #include <physapi.h>
  38 #include <phcore.h>
  39 #include <phmod.h>
  40 #include <phmods.h>
  41 #include <phctrl.h>
  42 #include <phflist.h>
  43 #include <phdbg.h>
  44 #include <physcast.h>
  45
  46 #include <mprintf.h>
  47 #include <memall.h>
  48 #include <dbmem.h>   // must be last header!
  49
  50 //#define PHYS_TEST_APPLY_FORCES
  51 //#define PHYS_TEST_ROTATIONAL_VELOCITY
  52 #define PHYS_TEST_VELOCITY
  53
  54
  55 BOOL OpenPos(ObjID objID)
  56 {
  57    PhysAxisControlRotationalVelocity(objID, 2, -3);
  58    return TRUE;
  59 }
  60
  61 BOOL ClosePos(ObjID objID)
  62 {
  63    PhysAxisControlRotationalVelocity(objID, 2, 3);
  64    return FALSE;
  65 }
  66
  67 void PhysicsTestRaycast(ObjID objID)
  68 {
  69    Location loc;
  70    Location end;
  71    Location hit;
  72    mxs_angvec ang;
  73    ObjID hit_obj;
  74
  75    CameraGetLocation(PlayerCamera(), &loc.vec, &ang);
  76
  77    mxs_matrix mat;
  78    mxs_vector dir;
  79
  80    mx_ang2mat(&mat, &ang);
  81
  82    mxs_real length = 10.0;
  83    config_get_float("physcast_length", &length);
  84
  85    mx_scale_vec(&dir, &mat.vec[0], length);
  86
  87    mx_add_vec(&end.vec, &loc.vec, &dir);
  88
  89    MakeLocationFromVector(&loc, &loc.vec);
  90    MakeLocationFromVector(&end, &end.vec);
  91
  92    int result = PhysRaycast(loc, end, &hit, &hit_obj, kCollideAll);
  93
  94    if (result != kCollideNone)
  95    {
  96       ObjPosUpdate(objID, &hit.vec, &ang);
  97    }
  98    else
  99    {
 100       ObjPosUpdate(objID, &end.vec, &ang);
 101    }
 102 }
 103
 104 void PhysicsLaunchSphere(mxs_real speed)
 105 {
 106    AutoAppIPtr(ObjectSystem);
 107
 108    ObjID objID;
 109
 110    objID = pObjectSystem->Create(-506, kObjectConcrete);
 111 #if 0
 112    ObjSetCollisionType(objID, COLLISION_BOUNCE | COLLISION_NO_SOUND);
 113    ObjSetModelName(objID, "wcratec");
 114 #endif
 115    ObjPosUpdate(objID, &PlayerCamera()->pos, &PlayerCamera()->ang);
 116
 117    PhysDeregisterModel(objID);
 118    PhysRegisterSphereHat(objID, 0, 1);
 119    g_PhysModels.GetActive(objID)->SetRotAxes(XAxis | YAxis | ZAxis);
 120    g_PhysModels.GetActive(objID)->SetRestAxes(XAxis | YAxis | ZAxis| NegXAxis | NegYAxis | NegZAxis);
 121    PhysAxisSetVelocity(objID, 0, speed);
 122
 123    PhysSetMass(objID, 20);
 124    PhysSetDensity(objID, .9);
 125    PhysSetElasticity(objID, 0);
 126 }
 127
 128 void PhysicsLaunchOBB(mxs_real speed)
 129 {
 130    IObjectSystem *pObjSys = AppGetObj(IObjectSystem);
 131    ObjID objID;
 132    objID = pObjSys->Create(ROOT_ARCHETYPE, kObjectConcrete);
 133    ObjSetCollisionType(objID, COLLISION_BOUNCE);
 134    ObjSetModelName(objID, "table");
 135    ObjPosUpdate(objID, &(PlayerCamera()->pos), &(PlayerCamera()->ang));
 136    PhysRegisterOBBDefault(objID);
 137
 138    PhysAxisSetVelocity(objID, 0, speed);
 139 }
 140
 141 void PhysicsJoyride()
 142 {
 143    static BOOL status = TRUE;
 144
 145    if (!PlayerObjectExists())
 146       return;
 147
 148    cPhysModel *pModel = g_PhysModels.GetActive(PlayerObject());
 149
 150    if (pModel == NULL)
 151       return;
 152
 153    if (status == TRUE)
 154    {
 155       pModel->SetSpringTension(0, .8);
 156       pModel->SetSpringDamping(0, .94);
 157
 158       status = FALSE;
 159    }
 160    else
 161    {
 162       pModel->SetSpringTension(0, .4);
 163       pModel->SetSpringDamping(0, .2);
 164
 165       status = TRUE;
 166    }
 167 }
 168
 169 #ifdef PHYS_TEST_VELOCITY
 170 void PhysicsSetControl(mxs_real speed)
 171 {
 172    cPhysModel *pModel;
 173    cPhysCtrlData *pCtrl;
 174    mxs_vector pos, unit, ctrl;
 175    mxs_angvec ang;
 176    mxs_matrix m;
 177
 178    if (!PhysObjHasPhysics(4))
 179       return;
 180
 181    CameraGetLocation(PlayerCamera(), &pos, &ang);
 182    mx_ang2mat(&m, &ang);
 183    mx_unit_vec(&unit, 0);
 184    mx_mat_mul_vec(&ctrl, &m, &unit);
 185    mx_scaleeq_vec(&ctrl, speed);
 186
 187    pModel = g_PhysModels.GetActive(4);
 188    if (pModel->IsControllable())
 189    {
 190       pCtrl = pModel->GetControls(0);
 191
 192       pCtrl->SetControlVelocity(ctrl);
 193    }
 194 }
 195
 196
 197 void PhysicsStopControl()
 198 {
 199    if (!PhysObjHasPhysics(4))
 200       return;
 201
 202    cPhysModel *pModel = g_PhysModels.GetActive(4);
 203    if (pModel->IsControllable())
 204    {
 205       cPhysCtrlData *pCtrl = pModel->GetControls(0);
 206
 207       pCtrl->StopControlVelocity();
 208    }
 209 }
 210 #endif
 211
 212 #ifdef PHYS_TEST_APPLY_FORCES
 213 void PhysicsSetControl(mxs_real speed)
 214 {
 215    mxs_vector     pos, end, force, unit, offset;
 216    mxs_angvec     ang;
 217    mxs_matrix     m;
 218    mxs_real       time;
 219    BOOL           result;
 220    sPhysForce    *flist;
 221    int            nforces;
 222
 223    if (!PhysObjHasPhysics(4))
 224       return;
 225
 226    CameraGetLocation(PlayerCamera(), &pos, &ang);
 227    mx_ang2mat(&m, &ang);
 228    mx_unit_vec(&unit, 0);
 229    mx_mat_mul_vec(&offset, &m, &unit);
 230    mx_scaleeq_vec(&offset, speed);
 231    mx_addeq_vec(&pos, &offset);
 232
 233    PhysGetForceList(4, 0, &flist, &nforces);
 234    result  = PhysApplyForceList(4, 0, NULL, 0, .3, &pos, &end, &force, &time);
 235
 236    if (result)
 237    {
 238       cPhysModel *pModel = g_PhysModels.GetActive(4);
 239
 240       ObjUpdateLocation(pModel->GetObjID(), OBJID_TO_PTR(pModel->GetObjID()),
 241                         pModel->GetLocationVec(0).x,
 242                         pModel->GetLocationVec(0).y,
 243                         pModel->GetLocationVec(0).z);
 244    }
 245    else
 246    {
 247       PhysClearForceList(4, 0);
 248    }
 249 }
 250
 251 void PhysicsStopControl()
 252 {
 253    if (!PhysObjHasPhysics(4))
 254       return;
 255
 256    cPhysModel *pModel = g_PhysModels.GetActive(4);
 257    cPhysCtrlData *pCtrl = pModel->GetControls(0);
 258
 259    pCtrl->StopControlLocation();
 260 }
 261 #endif
 262
 263
 264 #ifdef PHYS_TEST_ROTATIONAL_VELOCITY
 265 void PhysicsSetControl(mxs_real speed)
 266 {
 267    cPhysModel *pModel, *pModelNext;
 268    cPhysCtrlData *pCtrl;
 269    mxs_vector rot_speed = {speed * rand() / 32768, speed * rand() / 32768, speed * rand() / 32768};
 270
 271    pModel = g_PhysModels.GetFirstActive();
 272    while (pModel != NULL)
 273    {
 274       pModelNext = g_PhysModels.GetNextActive(pModel);
 275       pCtrl = pModel->GetControls(0);
 276       pCtrl->SetControlRotationalVelocity(rot_speed);
 277       pModel = pModelNext;
 278    }
 279 }
 280
 281 void PhysicsStopControl()
 282 {
 283    cPhysModel *pModel, *pModelNext;
 284    cPhysCtrlData  *pCtrl;
 285
 286    pModel = g_PhysModels.GetFirstActive();
 287    while (pModel != NULL)
 288    {
 289       pModelNext = g_PhysModels.GetNextActive(pModel);
 290       pCtrl = pModel->GetControls(0);
 291       pCtrl->StopControlRotationalVelocity();
 292       pModel = pModelNext;
 293    }
 294 }
 295 #endif
 296
 297 #ifdef DBG_ON
 298 ///////////////////////////////////////
 299 //
 300 // Set debugging info for specific model/type of event
 301 //
 302
 303 void PhysicsDebugObj(ObjID objID)
 304 {
 305    g_PhysicsDebug.SetDebugObj(objID, kPhysicsDebugAll);
 306 }
 307
 308 ///////////////////////////////////////
 309
 310 void PhysicsDebug(int what)
 311 {
 312    g_PhysicsDebug.SetDebugAll(what);
 313 }
 314 #endif // DBG_ON
 315
 316 #endif
 317
 318
 319
 320
 321