heretic2-sdk/Toolkit/Programming/GameCode/game/g_Skeletons.c

//
// g_Skeletons.c
//
// Copyright 1998 Raven Software
//
// Heretic II
//

#include "g_Skeletons.h"
#include "ArrayedList.h"

#include "g_local.h"

#include <assert.h>

G_SkeletalJoint_t skeletalJoints[MAX_ARRAYED_SKELETAL_JOINTS];
ArrayedListNode_t jointNodes[MAX_ARRAYED_JOINT_NODES];

// ********************************************************************
// Skeleton Managment stuff
// ********************************************************************

static int GetRootIndex(int max, int numJoints)
{
	int i, j, max2;
	qboolean cont = false;

	for(i = 0; i < max; ++i)
	{
		if(!skeletalJoints[i].inUse)
		{
			max2 = i + numJoints;

			// check the size of the array
			if(max2 > max)
			{
				assert(0);
				return -1;
			}

			// check for a big enough unused block
			for(j = i + 1; j < max2; ++j)
			{
				if(skeletalJoints[j].inUse)
				{
					i = j;
					cont = true;
					break;
				}
			}

			if(cont) // not a big enough block, so continue searching
			{
				cont = false;
				continue;
			}

			// found a block, mark it as used
			for(j = i; j < max2; ++j)
			{
				skeletalJoints[j].inUse = true;
			}

			return i;
		}
	}

	// couldn't find a block
	assert(0);
	return -1;
}

int CreateSkeleton(int structure)
{
	int index;

	index = GetRootIndex(MAX_ARRAYED_SKELETAL_JOINTS, numJointsInSkeleton[structure]);

	SkeletonCreators[structure](skeletalJoints, sizeof(G_SkeletalJoint_t), jointNodes, index);

	return index;
}

void FreeSkeleton(int root)
{
	int child;

	for(child = skeletalJoints[root].children; child != ARRAYEDLISTNODE_NULL; child = jointNodes[child].next)
	{
		FreeSkeleton(jointNodes[child].data);

		FreeNode(jointNodes, child);
	}

	skeletalJoints[root].inUse = false;
}

void UpdateSkeletons()
{
	int i, j;

	for(i = 0; i < MAX_ARRAYED_SKELETAL_JOINTS; ++i)
	{
		G_SkeletalJoint_t *joint;
		joint = &skeletalJoints[i];

		if(joint->inUse)
		{
			for(j = 0; j < 3; ++j)
			{
				float destAngle, *angle;

				joint->changed[j] = false;
				destAngle = joint->destAngles[j];
				angle = joint->angles + j;

				if(*angle != destAngle)
				{
					*angle += joint->angVels[j]*FRAMETIME;

					if(joint->angVels[j] > 0)
					{
						if(*angle > destAngle)
						{
							*angle = destAngle;
						}
					}
					else if(joint->angVels[j] < 0)
					{
						if(*angle < destAngle)
						{
							*angle = destAngle;
						}
					}
				}
			}
		}
	}	
}

// ********************************************************************
// Skeletal Manipulation stuff
//
// Mirrored in cl_Skeletons.c
// ********************************************************************

float GetJointAngle(int jointIndex, int angleIndex)
{
	return skeletalJoints[jointIndex].angles[angleIndex];
}

qboolean SetJointAngVel(int jointIndex, int angleIndex, float destAngle, float angSpeed)
{
	G_SkeletalJoint_t *joint;

	joint = &skeletalJoints[jointIndex];

	if(destAngle < joint->destAngles[angleIndex])
	{
		skeletalJoints[jointIndex].destAngles[angleIndex] = destAngle;
		skeletalJoints[jointIndex].angVels[angleIndex] = -angSpeed;
		skeletalJoints[jointIndex].changed[angleIndex] = true;
		return true;
	}
	else if(destAngle > joint->destAngles[angleIndex])
	{
		skeletalJoints[jointIndex].destAngles[angleIndex] = destAngle;
		skeletalJoints[jointIndex].angVels[angleIndex] = angSpeed;
		skeletalJoints[jointIndex].changed[angleIndex] = true;
		return true;
	}
	else
	{
		return false;
	}
}