1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
|
/**
* @file llkeyframefallmotion.cpp
* @brief Implementation of LLKeyframeFallMotion class.
*
* Copyright (c) 2001-$CurrentYear$, Linden Research, Inc.
* $License$
*/
//-----------------------------------------------------------------------------
// Header Files
//-----------------------------------------------------------------------------
#include "linden_common.h"
#include "llkeyframefallmotion.h"
#include "llcharacter.h"
#include "m3math.h"
//-----------------------------------------------------------------------------
// Macros
//-----------------------------------------------------------------------------
#define GO_TO_KEY_POSE 1
#define MIN_TRACK_SPEED 0.01f
//-----------------------------------------------------------------------------
// LLKeyframeFallMotion()
// Class Constructor
//-----------------------------------------------------------------------------
LLKeyframeFallMotion::LLKeyframeFallMotion(const LLUUID &id) : LLKeyframeMotion(id)
{
mVelocityZ = 0.f;
mCharacter = NULL;
}
//-----------------------------------------------------------------------------
// ~LLKeyframeFallMotion()
// Class Destructor
//-----------------------------------------------------------------------------
LLKeyframeFallMotion::~LLKeyframeFallMotion()
{
}
//-----------------------------------------------------------------------------
// LLKeyframeFallMotion::onInitialize()
//-----------------------------------------------------------------------------
LLMotion::LLMotionInitStatus LLKeyframeFallMotion::onInitialize(LLCharacter *character)
{
// save character pointer for later use
mCharacter = character;
// load keyframe data, setup pose and joint states
LLMotion::LLMotionInitStatus result = LLKeyframeMotion::onInitialize(character);
for (U32 jm=0; jm<mJointMotionList->mNumJointMotions; jm++)
{
if (!mJointStates[jm].getJoint())
continue;
if (mJointStates[jm].getJoint()->getName() == std::string("mPelvis"))
{
mPelvisStatep = &mJointStates[jm];
}
}
return result;
}
//-----------------------------------------------------------------------------
// LLKeyframeFallMotion::onActivate()
//-----------------------------------------------------------------------------
BOOL LLKeyframeFallMotion::onActivate()
{
LLVector3 ground_pos;
LLVector3 ground_normal;
LLQuaternion inverse_pelvis_rot;
LLVector3 fwd_axis(1.f, 0.f, 0.f);
mVelocityZ = -mCharacter->getCharacterVelocity().mV[VZ];
mCharacter->getGround( mCharacter->getCharacterPosition(), ground_pos, ground_normal);
ground_normal.normVec();
inverse_pelvis_rot = mCharacter->getCharacterRotation();
inverse_pelvis_rot.transQuat();
// find ground normal in pelvis space
ground_normal = ground_normal * inverse_pelvis_rot;
// calculate new foward axis
fwd_axis = fwd_axis - (ground_normal * (ground_normal * fwd_axis));
fwd_axis.normVec();
mRotationToGroundNormal = LLQuaternion(fwd_axis, ground_normal % fwd_axis, ground_normal);
return LLKeyframeMotion::onActivate();
}
//-----------------------------------------------------------------------------
// LLKeyframeFallMotion::onUpdate()
//-----------------------------------------------------------------------------
BOOL LLKeyframeFallMotion::onUpdate(F32 activeTime, U8* joint_mask)
{
BOOL result = LLKeyframeMotion::onUpdate(activeTime, joint_mask);
F32 slerp_amt = clamp_rescale(activeTime / getDuration(), 0.5f, 0.75f, 0.f, 1.f);
mPelvisStatep->setRotation(mPelvisStatep->getRotation() * slerp(slerp_amt, mRotationToGroundNormal, LLQuaternion()));
return result;
}
//-----------------------------------------------------------------------------
// LLKeyframeFallMotion::getEaseInDuration()
//-----------------------------------------------------------------------------
F32 LLKeyframeFallMotion::getEaseInDuration()
{
if (mVelocityZ == 0.f)
{
// we've already hit the ground
return 0.4f;
}
return mCharacter->getPreferredPelvisHeight() / mVelocityZ;
}
// End
|
