/************************************************************
 *                                                          *
 *       simple 3D object viewer                            *
 * Join some things together                                *
 *                                                          *
 ***********************************************************/


#include <libps.h>
#include "herodata.h"               //tmd addresses in herodata.h used dataman

#define  SCREEN_WIDTH 360
#define	SCREEN_HEIGHT 256
#define  PACKETMAX2 (4096*60)         /* Max GPU packets */
static 	PACKET packetArea[2][PACKETMAX2]; /* GPU PACKETS AREA */

#define	UNIT		1


#define  TRUE     1
#define 	FALSE 	0

#define  OT_LENGTH   14
static 	GsOT Wot[2];			/* Handler of OT */
static 	GsOT_TAG wtags[2][1<<OT_LENGTH];

static 	GsRVIEW2 view;
int 		ProjectionDistance;

GsF_LIGHT 	TheLights[3];

#define  NUMOBJS 13
#define  DIVAMT 128
#define  NUMPEOPLE 1

typedef struct
{
   GsDOBJ2  handler;                   // holds the object tmd and stuff
   VECTOR position;                    // position
   VECTOR partposition;                // position of the part in relation to parent
   SVECTOR rotate;                     // angle
   SVECTOR partrotate;                 // angle of the part
   GsCOORDINATE2 coord;                // coordinate system
   MATRIX tmpmatrix;                   // for holding new origin of object
   int   whoami;                       // the number of who I am in the skeleton
   int   parent;                       // object that this connects to
} ObjectHandler;
ObjectHandler theobjects;//[NUMOBJS];

typedef struct
{
   VECTOR position;                    // position
   ObjectHandler theobjects[NUMOBJS];
} Person;
Person people[NUMPEOPLE];


int dbug;                               // used in debug routines
int armanglex, armangley, armanglez;    // holds total amount of angle allowed
int leganglex, legangley, leganglez;
int armcx, armcy, armcz;                // holds current position of limbs
int legcx, legcy, legcz;

volatile u_char *bb0, *bb1;	   // low-level pad buffers: never need to touch

	 // constants for interface	to controller pad
#define PADLup     (1<<12)
#define PADLdown   (1<<14)
#define PADLleft   (1<<15)
#define PADLright  (1<<13)
#define PADRup     (1<< 4)
#define PADRdown   (1<< 6)
#define PADRleft   (1<< 7)
#define PADRright  (1<< 5)
#define PADi       (1<< 9)
#define PADj       (1<<10)
#define PADk       (1<< 8)
#define PADl       (1<< 3)
#define PADm       (1<< 1)
#define PADn       (1<< 2)
#define PADo       (1<< 0)
#define PADh       (1<<11)
#define PADL1      PADn
#define PADL2      PADo
#define PADR1      PADl
#define PADR2      PADm
#define PADstart   PADh
#define PADselect  PADk

/****************************************************************************
					prototypes
****************************************************************************/

void main (void);
void movelimbs(int pernum);
int DealWithControllerPad(void);
void InitialiseAll(void);
void SetUpTheObject(void);
void UpdateObjectCoordinates (SVECTOR* rotationVector,GsCOORDINATE2* coordSystem);
void PadInit (void);
u_long PadRead(void);
void updateobj (int objnum); 	// this one is for keeping objects together
void dofirstobject (int objnum); 	// operations on the first object
void dootherobjects (int objnum); 	// operations on the other objects

/****************************************************************************
					 functions
****************************************************************************/

void main (void)
{
	int side;			  // buffer index
	MATRIX	tmpls, tmplw;
	int objnum;	// the object array number
   int pernum;                          // the person number
	dbug=FALSE;		// whether or not to print dbug info
	InitialiseAll();

	side = GsGetActiveBuff();

	for(;;) {
		if (DealWithControllerPad() == 0)	   // quitting
			break;

		GsSetWorkBase((PACKET*)packetArea[side]);

      GsClearOt(0,0,&Wot[side]);

      for (pernum=0; pernum<NUMPEOPLE; pernum++) {  // for each person
         movelimbs(pernum);
         for (objnum=0; objnum<=NUMOBJS; objnum++) {  // for each limb
            UpdateObjectCoordinates(&people[pernum].theobjects[objnum].rotate, &people[pernum].theobjects[objnum].coord);
            updateobj(objnum);
            people[pernum].theobjects[objnum].handler.coord2->coord.t[0] = people[pernum].theobjects[objnum].position.vx;
            people[pernum].theobjects[objnum].handler.coord2->coord.t[1] =(people[pernum].theobjects[objnum].position.vy);// + theobjects[objnum].height);
            people[pernum].theobjects[objnum].handler.coord2->coord.t[2] = people[pernum].theobjects[objnum].position.vz;
            GsGetLs(&(people[pernum].theobjects[objnum].coord), &tmpls);
            GsSetLightMatrix(&tmpls);
            GsSetLsMatrix(&tmpls);
            GsSortObject4( &(people[pernum].theobjects[objnum].handler), &Wot[side], 3, getScratchAddr(0));
         }
      }
      GsSetRefView2(&view);
      FntPrint("XYZ: %d,%d,%d\n",people[0].theobjects[0].rotate.vx,people[0].theobjects[0].rotate.vy,people[0].theobjects[0].rotate.vz);
		FntPrint("Vp: %d,%d,%d\n",view.vpx,view.vpy,view.vpz);
		FntFlush(-1);

		VSync(0);

		ResetGraph(1);
		GsSwapDispBuff();
      GsSortClear(0,0,4,&Wot[side]);
		GsDrawOt(&Wot[side]);
		side ^= 1;
	}

		// program cleanup
	ResetGraph(3);
}

/*=======================================================================*/
void movelimbs(int pernum)                        // move all the limbs
{

/*   if ( ++armcz > armanglez ) armcz=0;
   if ( ++armcx > armanglex ) armcx=0;
   if ( ++armcy > armangley ) armcy=0;
   if ( ++legcz > leganglez ) legcz=0;
   if ( ++legcx > leganglex ) legcx=0;
   if ( ++legcy > legangley ) legcy=0;
   people[pernum].theobjects[2].partrotate.vz = -1 * (people[pernum].theobjects[3].partrotate.vz += (legcz  - (int)leganglez/2) * (ONE/1024));
   people[pernum].theobjects[2].partrotate.vx =      (people[pernum].theobjects[3].partrotate.vx += (legcx  - (int)leganglex/2) * (ONE/1024));
   people[pernum].theobjects[2].partrotate.vy = -1 * (people[pernum].theobjects[3].partrotate.vy += (legcy  - (int)legangley/2) * (ONE/1024));
*/
//   theobjects[6].partrotate.vz = theobjects[2].partrotate.vz;
//   theobjects[7].partrotate.vz = theobjects[3].partrotate.vz;


}

/*=======================================================================*/
void updateobj (int objnum) 	// do the bounce
{
  	if(dbug) printf("in updateobj for object number %d\n",objnum);

	if(objnum==0) {
		dofirstobject(objnum); 		// Special 1st object functions
  	} else {
		dootherobjects(objnum);		// Special other object functions
  	}
		// Generic functions that happen to all objects go here
//   if (theobjects[objnum].handler.coord2->coord.t[1] != theobjects[objnum].ceiling) {   }
}

/*=======================================================================*/
void dofirstobject (int objnum) 	// do the bounce
{
  	if(dbug) printf("in dofirstobject for object number %d\n",objnum);
/*   theobjects[objnum].height += (theobjects[objnum].velocity += theobjects[objnum].gravity);
	if (theobjects[objnum].height <= theobjects[objnum].floor) {
		theobjects[objnum].height = theobjects[objnum].floor;
		theobjects[objnum].velocity = 0;
	}
	if (theobjects[objnum].height >= theobjects[objnum].ceiling) {
		theobjects[objnum].height = theobjects[objnum].ceiling;
		theobjects[objnum].velocity = -theobjects[objnum].velocity;
	}
*/
}
/*=======================================================================*/
void dootherobjects (int objnum)    // all objects follow the rotation of the first object
{
   int pernum;
   for ( pernum=0; pernum<NUMPEOPLE; pernum++)  {
//    theobjects[objnum].height = theobjects[0].height;
      people[pernum].theobjects[objnum].rotate.vz =  people[pernum].theobjects[objnum].partrotate.vz;
      people[pernum].theobjects[objnum].rotate.vy =  people[pernum].theobjects[objnum].partrotate.vy;
      people[pernum].theobjects[objnum].rotate.vx =  people[pernum].theobjects[objnum].partrotate.vx;
   }
}
/*=======================================================================*/
	// load texture into frame buffer
void texture_init(u_long addr)          // no textures in this one
{
  RECT rect1;		   // destination on frame buffer
  GsIMAGE tim1;		   // info on TIM picture

  GsGetTimInfo((u_long *)(addr+4),&tim1);
  rect1.x=tim1.px;
  rect1.y=tim1.py;
  rect1.w=tim1.pw;
  rect1.h=tim1.ph;
  LoadImage(&rect1,tim1.pixel);
  if((tim1.pmode>>3)&0x01)	/* if clut exists, load it up */
    {
      rect1.x=tim1.cx;
      rect1.y=tim1.cy;
      rect1.w=tim1.cw;
      rect1.h=tim1.ch;
      LoadImage(&rect1,tim1.clut);
    }
}

/*=======================================================================*/
int DealWithControllerPad (void)
{
	long pad = PadRead();
   int pernum;

	if (pad & PADstart && pad & PADselect)		// quit program
		return 0;
   if (pad & PADstart) {
      view.vrx = 5000*UNIT;              // reset viewpoint
      view.vry = 0*UNIT;
      view.vrz = -2000*UNIT;
      view.vpx = 5000*UNIT;
      view.vpy = -600*UNIT;
      view.vpz = -5000*UNIT;
      view.rz = 0;
   }
   for(pernum=0; pernum<NUMPEOPLE; pernum++) {
      if (pad & PADstart) {
         people[pernum].theobjects[0].rotate.vx = (ONE/DIVAMT) * 0;
         people[pernum].theobjects[0].rotate.vy = (ONE/DIVAMT) * 0;
         people[pernum].theobjects[0].rotate.vz = (ONE/DIVAMT) * 0;
      }
				// rotations
      if (pad & PADL1)     people[pernum].theobjects[0].rotate.vy -= ONE/DIVAMT;
      if (pad & PADL2)     people[pernum].theobjects[0].rotate.vy += ONE/DIVAMT;

      if (pad & PADR1)     view.vpz -= ONE/64;  // zoom in and out
      if (pad & PADR2)     view.vpz += ONE/64;
      if (pad & PADRleft)  {
         if (pad & PADLleft)  people[pernum].theobjects[3].partrotate.vx -= ONE/DIVAMT;  // left arm
         if (pad & PADLright) people[pernum].theobjects[3].partrotate.vx += ONE/DIVAMT;
         if (pad & PADLup)    people[pernum].theobjects[5].partrotate.vx -= ONE/DIVAMT;  // forearm
         if (pad & PADLdown)  people[pernum].theobjects[5].partrotate.vx += ONE/DIVAMT;
      }
      if (pad & PADRright) {
         if (pad & PADLleft)  people[pernum].theobjects[8].partrotate.vx -= ONE/DIVAMT;  // right leg
         if (pad & PADLright) people[pernum].theobjects[8].partrotate.vx += ONE/DIVAMT;
         if (pad & PADLup)    people[pernum].theobjects[10].partrotate.vx -= ONE/DIVAMT;  // calf
         if (pad & PADLdown)  people[pernum].theobjects[10].partrotate.vx += ONE/DIVAMT;
      }
      if (pad & PADRup)    {
         if (pad & PADLleft)  people[pernum].theobjects[2].partrotate.vx -= ONE/DIVAMT;  // right arm
         if (pad & PADLright) people[pernum].theobjects[2].partrotate.vx += ONE/DIVAMT;
         if (pad & PADLup)    people[pernum].theobjects[4].partrotate.vx -= ONE/DIVAMT;  // forearm
         if (pad & PADLdown)  people[pernum].theobjects[4].partrotate.vx += ONE/DIVAMT;
      }
      if (pad & PADRdown)  {
         if (pad & PADLleft)  people[pernum].theobjects[9].partrotate.vx -= ONE/DIVAMT;  // left leg
         if (pad & PADLright) people[pernum].theobjects[9].partrotate.vx += ONE/DIVAMT;
         if (pad & PADLup)    people[pernum].theobjects[11].partrotate.vx -= ONE/DIVAMT;  // calf
         if (pad & PADLdown)  people[pernum].theobjects[11].partrotate.vx += ONE/DIVAMT;
      }
   }                                    // end of pernum
	return 1;
}


/*=======================================================================*/
void InitialiseAll (void)
{
	int i;

	PadInit();				 		// init controller pad

								// main graphical initialisations
	SetVideoMode(MODE_PAL);
	GsInitGraph(SCREEN_WIDTH,SCREEN_HEIGHT,GsINTER|GsOFSGPU,1,0);
	GsDefDispBuff(0,0,0,SCREEN_HEIGHT);
	GsInit3D();

	Wot[0].length=OT_LENGTH;
	Wot[0].org=wtags[0];
	Wot[1].length=OT_LENGTH;
	Wot[1].org=wtags[1];

	GsClearOt(0,0,&Wot[0]);
	GsClearOt(0,0,&Wot[1]);

	ProjectionDistance = 192;			// screen to viewpoint distance
	GsSetProjection(ProjectionDistance);

      view.vrx = 5000*UNIT;              // reset viewpoint
      view.vry = 0*UNIT;
      view.vrz = -2000*UNIT;
      view.vpx = 5000*UNIT;
      view.vpy = -600*UNIT;
      view.vpz = -5000*UNIT;
      view.rz = 0;
	view.super = WORLD;
	GsSetRefView2(&view);

		// three flat lights
	TheLights[0].vx = ONE; TheLights[0].vy = 0; TheLights[0].vz = 0;
	TheLights[0].r = 128; TheLights[0].g = 50; TheLights[0].b = 50;
	GsSetFlatLight(0, &TheLights[0]);

	TheLights[1].vx = 0; TheLights[1].vy = ONE; TheLights[1].vz = 0;
	TheLights[1].r = 50; TheLights[1].g = 128; TheLights[1].b = 50;
	GsSetFlatLight(1, &TheLights[1]);

	TheLights[2].vx = 0; TheLights[2].vy = 0; TheLights[2].vz = ONE;
	TheLights[2].r = 50; TheLights[2].g = 50; TheLights[2].b = 128;
	GsSetFlatLight(2, &TheLights[2]);

	FntLoad( 960, 256);
	FntOpen( 0, 40, 256, 200, 0, 512);

	SetUpTheObject();
//  	texture_init(TEXTURE1_ADDRESS);


   armanglex = 30;                      // set up the allowed angles
   armangley = 0;                       // for the limbs
   armanglez = 30;
   leganglex = 30;
   legangley = 0;
   leganglez = 0;

}


/*=======================================================================*/
void SetUpTheObject (void)
{
	u_long *pointer;
   int pernum,objnum,i;

   for (pernum = 0; pernum<NUMPEOPLE; pernum++) {  // for each person
      for (objnum = 0; objnum<=NUMOBJS; objnum++) {  // for each limb
         if(dbug) printf("in SetUpTheObject for object number %d\n",objnum);
         if(objnum!=0){                    // set up everything but the main object ie body
            switch(objnum) { // head llarm rarm lleg rleg lfarm rfarm lcalf rcalf
            case 1 : people[pernum].theobjects[objnum].parent=0;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(0*UNIT);  // head
                  people[pernum].theobjects[objnum].position.vy = -(200*UNIT);
                  people[pernum].theobjects[objnum].position.vz = +0;
                  break;
            case 2 : people[pernum].theobjects[objnum].parent=0;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(80*UNIT);  // hlshol
                  people[pernum].theobjects[objnum].position.vy = -(180*UNIT);
                  people[pernum].theobjects[objnum].position.vz = +0;
                  break;
            case 3 : people[pernum].theobjects[objnum].parent=0;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = -(80*UNIT);  // hrshol
                  people[pernum].theobjects[objnum].position.vy = -(180*UNIT);
                  people[pernum].theobjects[objnum].position.vz = +0;
                  break;

            case 4 : people[pernum].theobjects[objnum].parent=2;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(30*UNIT);  // hlfarm
                  people[pernum].theobjects[objnum].position.vy = +(130*UNIT);
                  people[pernum].theobjects[objnum].position.vz = +0;
                  break;
            case 5 : people[pernum].theobjects[objnum].parent=3;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = -(30*UNIT);  // hrfarm
                  people[pernum].theobjects[objnum].position.vy = +(130*UNIT);
                  people[pernum].theobjects[objnum].position.vz = +0;
                  break;
            case 6 : people[pernum].theobjects[objnum].parent=4;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = -(0*UNIT);  // hlhand
                  people[pernum].theobjects[objnum].position.vy = +(130*UNIT);
                  people[pernum].theobjects[objnum].position.vz = 0;
                  break;
            case 7 : people[pernum].theobjects[objnum].parent=5;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(0*UNIT);  // hrhand
                  people[pernum].theobjects[objnum].position.vy = +(130*UNIT);
                  people[pernum].theobjects[objnum].position.vz = 0;
                  break;

            case 8 : people[pernum].theobjects[objnum].parent=0;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = -(20*UNIT);  // hlthigh
                  people[pernum].theobjects[objnum].position.vy = -(20*UNIT);
                  people[pernum].theobjects[objnum].position.vz = 0;
                  break;
            case 9 : people[pernum].theobjects[objnum].parent=0;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(20*UNIT);  // hrthigh
                  people[pernum].theobjects[objnum].position.vy = -(20*UNIT);
                  people[pernum].theobjects[objnum].position.vz = 0;
                  break;
            case 10 : people[pernum].theobjects[objnum].parent=8;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(60*UNIT);  // hlcalf
                  people[pernum].theobjects[objnum].position.vy = +(120*UNIT);
                  people[pernum].theobjects[objnum].position.vz = +(12*UNIT);
                  break;
            case 11 : people[pernum].theobjects[objnum].parent=9;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = -(60*UNIT);  // hrcalf
                  people[pernum].theobjects[objnum].position.vy = +(120*UNIT);
                  people[pernum].theobjects[objnum].position.vz = +(12*UNIT);
                  break;
            case 12 : people[pernum].theobjects[objnum].parent=10;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = -(0*UNIT);  // hlfoot
                  people[pernum].theobjects[objnum].position.vy = +(150*UNIT);
                  people[pernum].theobjects[objnum].position.vz = 0;
                  break;
            case 13 : people[pernum].theobjects[objnum].parent=11;
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(50*UNIT);  // hrfoot
                  people[pernum].theobjects[objnum].position.vy = +(150*UNIT);
                  people[pernum].theobjects[objnum].position.vz = 0;
                  break;
            case 14 : people[pernum].theobjects[objnum].parent=11;  // this object cannot be seen
                  people[pernum].theobjects[objnum].coord.super = &people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord;
                  people[pernum].theobjects[objnum].position.vx = +(0*UNIT);  // hrfoot
                  people[pernum].theobjects[objnum].position.vy = +(150*UNIT);
                  people[pernum].theobjects[objnum].position.vz = 0;
                  break;


            default : printf("There has been an error placing object number %d\n", objnum); break;
            }
            GsInitCoordinate2(&people[pernum].theobjects[people[pernum].theobjects[objnum].parent].coord, &people[pernum].theobjects[objnum].coord);
         } else { // set up the body
            people[pernum].theobjects[objnum].parent = 0;
            people[pernum].theobjects[objnum].position.vx = 4500+((pernum+1)*100);//(5000*UNIT);// -(pernum*(25*UNIT));
            people[pernum].theobjects[objnum].position.vy = (-250*UNIT);// -(pernum*(10*UNIT));
            people[pernum].theobjects[objnum].position.vz = (-4500*UNIT);// -(pernum*(25*UNIT));
            people[pernum].theobjects[objnum].rotate.vy = 0;// * ONE/64;
            people[pernum].theobjects[objnum].rotate.vx = 0;// * ONE/64;
            people[pernum].theobjects[objnum].rotate.vz = 0;// * ONE/64;
            GsInitCoordinate2(WORLD, &people[pernum].theobjects[objnum].coord);
         }


         if(dbug) printf("in SetUpTheObject, 1\n");
         people[pernum].theobjects[objnum].handler.coord2 = &(people[pernum].theobjects[objnum].coord);
                           // set pointer to top of TMD in main memory
         switch(objnum) {
            case 0  : pointer = (u_long *)HBODY_DATA; break;
            case 1  : pointer = (u_long *)HHEAD_DATA; break;
            case 2  : pointer = (u_long *)HLSHOL_DATA; break;
            case 3  : pointer = (u_long *)HRSHOL_DATA; break;
            case 4  : pointer = (u_long *)HLFARM_DATA; break;
            case 5  : pointer = (u_long *)HRFARM_DATA; break;
            case 6  : pointer = (u_long *)HLHAND_DATA; break;
            case 7  : pointer = (u_long *)HRHAND_DATA; break;
            case 8  : pointer = (u_long *)HLTHIGH_DATA; break;
            case 9  : pointer = (u_long *)HRTHIGH_DATA; break;
            case 10 : pointer = (u_long *)HLCALF_DATA; break;
            case 11 : pointer = (u_long *)HRCALF_DATA; break;
            case 12 : pointer = (u_long *)HLFOOT_DATA; break;
            case 13 : pointer = (u_long *)HRFOOT_DATA; break;
            default : printf("There has been an error setting up object number %d\n", objnum);
         }
         if(dbug) printf("in SetUpTheObject, 2\n");
         pointer++;              // skip TMD header
         GsMapModelingData(pointer);      // Map TMD offset addresses to real addresses
         pointer += 2;           // skip some more
								// link TMD data to object handler
         GsLinkObject4( (u_long)pointer, &people[pernum].theobjects[objnum].handler, 0);
         if(dbug) printf("in SetUpTheObject, 3\n");

      }
   }
}

/*=======================================================================*/
void UpdateObjectCoordinates (SVECTOR* rotationVector,
							GsCOORDINATE2* coordSystem)
{
	MATRIX tempMatrix;

  	if(dbug) printf("in UpdateObjectCoordinates \n");
	tempMatrix.t[0] = coordSystem->coord.t[0];
	tempMatrix.t[1] = coordSystem->coord.t[1];
	tempMatrix.t[2] = coordSystem->coord.t[2];

	RotMatrix(rotationVector, &tempMatrix);	   // get rotation matrix from rotation vector

	coordSystem->coord = tempMatrix;	// assign new matrix to coordinate system

	coordSystem->flg = 0;  // tell GTE that coordinate system has been updated
}

/*=======================================================================*/
void PadInit (void)
{
	GetPadBuf(&bb0, &bb1);
}

/*=======================================================================*/
u_long PadRead(void)
{
	return(~(*(bb0+3) | *(bb0+2) << 8 | *(bb1+3) << 16 | *(bb1+2) << 24));
}