gtkradiant/tools/quake2/qdata_heretic2/jointed.c

/*
Copyright (C) 1999-2007 id Software, Inc. and contributors.
For a list of contributors, see the accompanying CONTRIBUTORS file.

This file is part of GtkRadiant.

GtkRadiant is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.

GtkRadiant 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 General Public License for more details.

You should have received a copy of the GNU General Public License
along with GtkRadiant; if not, write to the Free Software
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
*/

#include <assert.h>
#include <math.h>
#include "token.h"
#include "joints.h"
#include "angles.h"
#include "inout.h"

char *SKEL_ROOT_NAMES[] =
{
	"RAVEN_SPINE"
};

char *SKEL_NAMES[] =
{
	"RAVEN_WAIST1",
	"RAVEN_WAIST2",
	"RAVEN_NECK"
};

int NAME_OFFSETS[] =
{
	0
};

int numJointsForSkeleton[] = 
{
	NUM_JOINTS_RAVEN,
	NUM_JOINTS_BOX
};

float g_scaling[3];
float g_rotation[3];
float g_translation[3];

//==========================================================================
//
// LoadHRCClustered
//
//==========================================================================

static void LoadHRCClustered(char *fileName, int **clusterList, int *num_verts, int skelType)
{
	int i, j;

	TK_OpenSource(fileName);
	TK_FetchRequire(TK_HRCH);
	TK_FetchRequire(TK_COLON);
	TK_FetchRequire(TK_SOFTIMAGE);

	TK_Beyond(TK_CLUSTERS);

	while(TK_Search(TK_CLUSTER_NAME) != TK_EOF)
	{
		TK_Require(TK_STRING);

		for( i = 0; i < numJointsForSkeleton[skelType]; ++i)
		{
			if(stricmp(tk_String, SKEL_NAMES[NAME_OFFSETS[skelType]+i]) == 0)
			{
				i = -i + numJointsForSkeleton[skelType] - 1;

				TK_BeyondRequire(TK_NUM_CLUSTER_VERTICES, TK_INTNUMBER);

				num_verts[i+1] = tk_IntNumber;

				clusterList[i] = (int *) SafeMalloc(num_verts[i+1]*sizeof(int), "LoadHRCClustered");
				assert(clusterList[i]);
				// currently this function is only called by LoadTriangleListClustered, which in turn is only
				// called by Cmd_Base in qdata.  This is where the only call to free for this memory is being made.

				TK_Beyond(TK_LBRACE);

				for(j = 0; j < num_verts[i+1]; ++j)
				{
					TK_Require(TK_INTNUMBER);
					clusterList[i][j] = tk_IntNumber;
					TK_Fetch();
				}

				break;
			}
		}
	}

	num_verts[0] = numJointsForSkeleton[skelType];
}

static void LoadHRCGlobals(char *fileName)
{
	int i;

	TK_OpenSource(fileName);
	TK_FetchRequire(TK_HRCH);
	TK_FetchRequire(TK_COLON);
	TK_FetchRequire(TK_SOFTIMAGE);
	TK_Beyond(TK_MODEL);

	TK_Beyond(TK_SCALING);
	for(i = 0; i < 3; i++)
	{
		TK_Require(TK_FLOATNUMBER);
		g_scaling[i] = tk_FloatNumber;
		TK_Fetch();
	}

	TK_Beyond(TK_ROTATION);
	for(i = 0; i < 3; i++)
	{
		TK_Require(TK_FLOATNUMBER);
		g_rotation[i] = tk_FloatNumber;
		TK_Fetch();
	}

	TK_Beyond(TK_TRANSLATION);
	for(i = 0; i < 3; i++)
	{
		TK_Require(TK_FLOATNUMBER);
		g_translation[i] = tk_FloatNumber;
		TK_Fetch();
	}
}

static void ParseVec3(vec3_t in)
{
	TK_Require(TK_FLOATNUMBER);
	in[1] = tk_FloatNumber;
	TK_FetchRequire(TK_FLOATNUMBER);
	in[2] = tk_FloatNumber;
	TK_FetchRequire(TK_FLOATNUMBER);
	in[0] = tk_FloatNumber;
}

static void ParseRotation3(vec3_t in)
{
	TK_Require(TK_FLOATNUMBER);
	in[1] = -tk_FloatNumber;
	TK_FetchRequire(TK_FLOATNUMBER);
	in[2] = tk_FloatNumber;
	TK_FetchRequire(TK_FLOATNUMBER);
	in[0] = tk_FloatNumber;
}

static void ParseTranslation3(vec3_t in)
{
	TK_Require(TK_FLOATNUMBER);
	in[1] = tk_FloatNumber;
	TK_FetchRequire(TK_FLOATNUMBER);
	in[2] = tk_FloatNumber;
	TK_FetchRequire(TK_FLOATNUMBER);
	in[0] = tk_FloatNumber;
}

static void LoadHRCJointList(char *fileName, QDataJoint_t *jointList, int skelType)
{
#define MAX_STACK 64
	int i, j;
	vec3_t curTranslation[MAX_STACK], curRotation[MAX_STACK], curScale[MAX_STACK];
	int curCorrespondingJoint[MAX_STACK];
	int currentStack = 0, stackSize;
	int baseJoint;
	float cx, sx, cy, sy, cz, sz;
	float rx, ry, rz;
	float x2, y2, z2;


	TK_OpenSource(fileName);
	TK_FetchRequire(TK_HRCH);
	TK_FetchRequire(TK_COLON);
	TK_FetchRequire(TK_SOFTIMAGE);

	TK_Beyond(TK_MODEL);
	TK_Beyond(TK_MODEL);

/*	while(1)
	{
		TK_Beyond(TK_MODEL);
		TK_BeyondRequire(TK_NAME, TK_STRING);

		if(_stricmp(tk_String, SKEL_ROOT_NAMES[skelType]) == 0)
			break;
	}*/

	TK_Beyond(TK_SCALING);

	ParseVec3(curScale[currentStack]);

	TK_Beyond(TK_ROTATION);

	ParseRotation3(curRotation[currentStack]);

	TK_Beyond(TK_TRANSLATION);

	ParseVec3(curTranslation[currentStack]);

	// account for global model translation
	curTranslation[currentStack][1] += g_translation[0];
	curTranslation[currentStack][2] += g_translation[1];
	curTranslation[currentStack][0] += g_translation[2];

	++currentStack;

	for(i = 0; i < NUM_JOINTS_RAVEN; ++i)
	{
		while(1)
		{
			TK_Beyond(TK_MODEL);

//			TK_BeyondRequire(TK_NAME, TK_STRING);

//			if(_stricmp(tk_String, SKEL_NAMES[NAME_OFFSETS[skelType]+i]) == 0)
				break;

			TK_Beyond(TK_SCALING);

			ParseVec3(curScale[currentStack]);

			TK_Beyond(TK_ROTATION);

			ParseRotation3(curRotation[currentStack]);

			TK_Beyond(TK_TRANSLATION);

			ParseVec3(curTranslation[currentStack]);

			curCorrespondingJoint[currentStack] = -1;

			++currentStack;
		}

		TK_Beyond(TK_SCALING);

		ParseVec3(curScale[currentStack]);

		TK_Beyond(TK_ROTATION);

		ParseRotation3(curRotation[currentStack]);

		jointList[i].rotation[1] = curRotation[currentStack][1];
		jointList[i].rotation[2] = curRotation[currentStack][2];
		jointList[i].rotation[0] = curRotation[currentStack][0];

		TK_Beyond(TK_TRANSLATION);

		ParseVec3(curTranslation[currentStack]);

		jointList[i].placement.origin[1] = curTranslation[currentStack][1];
		jointList[i].placement.origin[2] = curTranslation[currentStack][2];
		jointList[i].placement.origin[0] = curTranslation[currentStack][0];

		jointList[i].placement.direction[1] = 7.5;
		jointList[i].placement.direction[2] = 0.0;
		jointList[i].placement.direction[0] = 0.0;

		jointList[i].placement.up[1] = 0.0;
		jointList[i].placement.up[2] = 7.5;
		jointList[i].placement.up[0] = 0.0;

		curCorrespondingJoint[currentStack] = i;

		++currentStack;
	}

	stackSize = currentStack;

	for(i = 0; i < NUM_JOINTS_RAVEN; ++i)
	{
		rx = jointList[i].rotation[0]*ANGLE_TO_RAD;
		ry = jointList[i].rotation[1]*ANGLE_TO_RAD;
		rz = jointList[i].rotation[2]*ANGLE_TO_RAD;

		cx = cos(rx);
		sx = sin(rx);

		cy = cos(ry);
		sy = sin(ry);

		cz = cos(rz);
		sz = sin(rz);

		// y-axis rotation for direction
		x2 = jointList[i].placement.direction[0]*cy+jointList[i].placement.direction[2]*sy;
		z2 = -jointList[i].placement.direction[0]*sy+jointList[i].placement.direction[2]*cy;
		jointList[i].placement.direction[0] = x2;
		jointList[i].placement.direction[2] = z2;

		// y-axis rotation for up
		x2 = jointList[i].placement.up[0]*cy+jointList[i].placement.up[2]*sy;
		z2 = -jointList[i].placement.up[0]*sy+jointList[i].placement.up[2]*cy;
		jointList[i].placement.up[0] = x2;
		jointList[i].placement.up[2] = z2;

		// z-axis rotation for direction
		x2 = jointList[i].placement.direction[0]*cz-jointList[i].placement.direction[1]*sz;
		y2 = jointList[i].placement.direction[0]*sz+jointList[i].placement.direction[1]*cz;
		jointList[i].placement.direction[0] = x2;
		jointList[i].placement.direction[1] = y2;

		// z-axis rotation for up
		x2 = jointList[i].placement.up[0]*cz-jointList[i].placement.up[1]*sz;
		y2 = jointList[i].placement.up[0]*sz+jointList[i].placement.up[1]*cz;
		jointList[i].placement.up[0] = x2;
		jointList[i].placement.up[1] = y2;

		// x-axis rotation for direction vector
		y2 = jointList[i].placement.direction[1]*cx-jointList[i].placement.direction[2]*sx;
		z2 = jointList[i].placement.direction[1]*sx+jointList[i].placement.direction[2]*cx;
		jointList[i].placement.direction[1] = y2;
		jointList[i].placement.direction[2] = z2;

		// x-axis rotation for up vector
		y2 = jointList[i].placement.up[1]*cx-jointList[i].placement.up[2]*sx;
		z2 = jointList[i].placement.up[1]*sx+jointList[i].placement.up[2]*cx;
		jointList[i].placement.up[1] = y2;
		jointList[i].placement.up[2] = z2;

		// translate to position in model
		jointList[i].placement.direction[0] += jointList[i].placement.origin[0];
		jointList[i].placement.direction[1] += jointList[i].placement.origin[1];
		jointList[i].placement.direction[2] += jointList[i].placement.origin[2];

		// translate to position in model
		jointList[i].placement.up[0] += jointList[i].placement.origin[0];
		jointList[i].placement.up[1] += jointList[i].placement.origin[1];
		jointList[i].placement.up[2] += jointList[i].placement.origin[2];
	}

	baseJoint = NUM_JOINTS_RAVEN;

	for(i = stackSize/*NUM_JOINTS_RAVEN*/ - 1; i > 0; --i)
	{

		rx = curRotation[i-1][0]*ANGLE_TO_RAD;
		ry = curRotation[i-1][1]*ANGLE_TO_RAD;
		rz = curRotation[i-1][2]*ANGLE_TO_RAD;

		cx = cos(rx);
		sx = sin(rx);

		cy = cos(ry);
		sy = sin(ry);

		cz = cos(rz);
		sz = sin(rz);

		for(j = i-1; j < stackSize-1; ++j)
		{
			// y-axis rotation for origin
			x2 = jointList[j].placement.origin[0]*cy+jointList[j].placement.origin[2]*sy;
			z2 = -jointList[j].placement.origin[0]*sy+jointList[j].placement.origin[2]*cy;
			jointList[j].placement.origin[0] = x2;
			jointList[j].placement.origin[2] = z2;

			// y-axis rotation for direction
			x2 = jointList[j].placement.direction[0]*cy+jointList[j].placement.direction[2]*sy;
			z2 = -jointList[j].placement.direction[0]*sy+jointList[j].placement.direction[2]*cy;
			jointList[j].placement.direction[0] = x2;
			jointList[j].placement.direction[2] = z2;

			// y-axis rotation for up
			x2 = jointList[j].placement.up[0]*cy+jointList[j].placement.up[2]*sy;
			z2 = -jointList[j].placement.up[0]*sy+jointList[j].placement.up[2]*cy;
			jointList[j].placement.up[0] = x2;
			jointList[j].placement.up[2] = z2;

			// z-axis rotation for origin
			x2 = jointList[j].placement.origin[0]*cz-jointList[j].placement.origin[1]*sz;
			y2 = jointList[j].placement.origin[0]*sz+jointList[j].placement.origin[1]*cz;
			jointList[j].placement.origin[0] = x2;
			jointList[j].placement.origin[1] = y2;

			// z-axis rotation for direction
			x2 = jointList[j].placement.direction[0]*cz-jointList[j].placement.direction[1]*sz;
			y2 = jointList[j].placement.direction[0]*sz+jointList[j].placement.direction[1]*cz;
			jointList[j].placement.direction[0] = x2;
			jointList[j].placement.direction[1] = y2;

			// z-axis rotation for up
			x2 = jointList[j].placement.up[0]*cz-jointList[j].placement.up[1]*sz;
			y2 = jointList[j].placement.up[0]*sz+jointList[j].placement.up[1]*cz;
			jointList[j].placement.up[0] = x2;
			jointList[j].placement.up[1] = y2;

			// x-axis rotation for origin
			y2 = jointList[j].placement.origin[1]*cx-jointList[j].placement.origin[2]*sx;
			z2 = jointList[j].placement.origin[1]*sx+jointList[j].placement.origin[2]*cx;
			jointList[j].placement.origin[1] = y2;
			jointList[j].placement.origin[2] = z2;

			// x-axis rotation for direction vector
			y2 = jointList[j].placement.direction[1]*cx-jointList[j].placement.direction[2]*sx;
			z2 = jointList[j].placement.direction[1]*sx+jointList[j].placement.direction[2]*cx;
			jointList[j].placement.direction[1] = y2;
			jointList[j].placement.direction[2] = z2;

			// x-axis rotation for up vector
			y2 = jointList[j].placement.up[1]*cx-jointList[j].placement.up[2]*sx;
			z2 = jointList[j].placement.up[1]*sx+jointList[j].placement.up[2]*cx;
			jointList[j].placement.up[1] = y2;
			jointList[j].placement.up[2] = z2;

			if(curCorrespondingJoint[j+1] != -1)
			{
				// translate origin
				jointList[j].placement.origin[0] += curTranslation[i-1][0];
				jointList[j].placement.origin[1] += curTranslation[i-1][1];
				jointList[j].placement.origin[2] += curTranslation[i-1][2];

				// translate back to local coord
				jointList[j].placement.direction[0] += curTranslation[i-1][0];
				jointList[j].placement.direction[1] += curTranslation[i-1][1];
				jointList[j].placement.direction[2] += curTranslation[i-1][2];

				// translate back to local coord
				jointList[j].placement.up[0] += curTranslation[i-1][0];
				jointList[j].placement.up[1] += curTranslation[i-1][1];
				jointList[j].placement.up[2] += curTranslation[i-1][2];
			}
		}
	}
}

void LoadGlobals(char *fileName)
{
	FILE *file1;
    int dot = '.';
	char *dotstart;
	char	InputFileName[256];

	dotstart = strrchr(fileName,dot); // Does it already have an extension on the file name?

	if (!dotstart)
	{
		strcpy(InputFileName, fileName);
		strcat(InputFileName, ".hrc");
		if((file1 = fopen(InputFileName, "rb")) != NULL)
		{
			fclose(file1);

			LoadHRCGlobals(InputFileName);

			printf(" - assuming .HRC\n");
			return;
		}

		Error("\n Could not open file '%s':\n"
			"No HRC match.\n", fileName);
	}
	else
	{
		if((file1 = fopen(fileName, "rb")) != NULL)
		{
			printf("\n");
			fclose(file1);
			if (strcmp(dotstart,".hrc") == 0 || strcmp(dotstart,".HRC") == 0)
			{
				LoadHRCGlobals(fileName);
				return;
			}
		}

		Error("Could not open file '%s':\n",fileName);
	}
}

void LoadClusters(char *fileName, int **clusterList, int *num_verts, int skelType)
{
	FILE *file1;
    int dot = '.';
	char *dotstart;
	char	InputFileName[256];

	dotstart = strrchr(fileName,dot); // Does it already have an extension on the file name?

	if (!dotstart)
	{
		strcpy(InputFileName, fileName);
		strcat(InputFileName, ".hrc");
		if((file1 = fopen(InputFileName, "rb")) != NULL)
		{
			fclose(file1);

			LoadHRCClustered(InputFileName, clusterList, num_verts, skelType);

			printf(" - assuming .HRC\n");
			return;
		}

		Error("\n Could not open file '%s':\n"
			"No HRC match.\n", fileName);
	}
	else
	{
		if((file1 = fopen(fileName, "rb")) != NULL)
		{
			printf("\n");
			fclose(file1);
			if (strcmp(dotstart,".hrc") == 0 || strcmp(dotstart,".HRC") == 0)
			{
				LoadHRCClustered(fileName, clusterList, num_verts, skelType);
				return;
			}
		}

		Error("Could not open file '%s':\n",fileName);
	}
}

void LoadJointList(char *fileName, QDataJoint_t *jointList, int skelType)
{
	FILE *file1;
    int dot = '.';
	char *dotstart;
	char	InputFileName[256];

	dotstart = strrchr(fileName,dot); // Does it already have an extension on the file name?

	if (!dotstart)
	{
		strcpy(InputFileName, fileName);
		strcat(InputFileName, ".hrc");
		if((file1 = fopen(InputFileName, "rb")) != NULL)
		{
			fclose(file1);

			LoadHRCJointList(InputFileName, jointList, skelType);

			printf(" - assuming .HRC\n");
			return;
		}

		Error("\n Could not open file '%s':\n"
			"No HRC.\n", fileName);
	}
	else
	{
		if((file1 = fopen(fileName, "rb")) != NULL)
		{
			printf("\n");
			fclose(file1);
			if (strcmp(dotstart,".hrc") == 0 || strcmp(dotstart,".HRC") == 0)
			{
				LoadHRCJointList(fileName, jointList, skelType);

				return;
			}
		}

		Error("Could not open file '%s':\n",fileName);
	}
}