/**************************************************************************
 *                                                                        *
 *               Copyright (C) 1995, Silicon Graphics, Inc.               *
 *                                                                        *
 *  These coded instructions, statements, and computer programs  contain  *
 *  unpublished  proprietary  information of Silicon Graphics, Inc., and  *
 *  are protected by Federal copyright  law.  They  may not be disclosed  *
 *  to  third  parties  or copied or duplicated in any form, in whole or  *
 *  in part, without the prior written consent of Silicon Graphics, Inc.  *
 *                                                                        *
 *************************************************************************/

/*---------------------------------------------------------------------*
        Copyright (C) 1998 Nintendo. (Originated by SGI)
        
        $RCSfile: rsplight.c,v $
        $Revision: 1.2 $
        $Date: 2003/04/05 15:44:27 $
 *---------------------------------------------------------------------*/

/*
 * File:	rsplight.c
 * Create Date: Fri Aug 18 10:12:49 PDT 1995	
 *
 *
 */

#include <ultra64.h>
#include <PR/ramrom.h>	/* needed for argument passing into the app */
#include <assert.h>

#include "rsplight.h"
#include "static.h"
#include "controller.h"

#define FAST3D 0

/*
 * Symbol genererated by "makerom" to indicate the end of the code segment
 * in virtual (and physical) memory
 */
extern char _codeSegmentEnd[];

/*
 * Symbols generated by "makerom" to tell us where the static segment is
 * in ROM.
 */
extern char _staticSegmentRomStart[], _staticSegmentRomEnd[];

/*
 * Stacks for the threads as well as message queues for synchronization
 * This stack is ridiculously large, and could also be reclaimed once
 * the main thread is started.
 */
u64	bootStack[STACKSIZE/sizeof(u64)];

static void	idle(void *);
static void	main(void *);

static OSThread	idleThread;
static u64	idleThreadStack[STACKSIZE/sizeof(u64)];

static OSThread	mainThread;
static u64	mainThreadStack[STACKSIZE/sizeof(u64)];

static OSThread	rmonThread;
static u64      rmonStack[RMON_STACKSIZE/sizeof(u64)];

/* this number (the depth of the message queue) needs to be equal
 * to the maximum number of possible overlapping PI requests.
 * For this app, 1 or 2 is probably plenty, other apps might
 * require a lot more.
 */
#define NUM_PI_MSGS     8

static OSMesg PiMessages[NUM_PI_MSGS];
static OSMesgQueue PiMessageQ;

OSMesgQueue     dmaMessageQ, rspMessageQ, rdpMessageQ, retraceMessageQ;
OSMesg          dmaMessageBuf, rspMessageBuf, rdpMessageBuf, retraceMessageBuf;
OSMesg          dummyMessage;
OSIoMesg        dmaIOMessageBuf;

char		*staticSegment;
OSMesg		dummyMesg;
OSTask		*tlistp;
Dynamic		*dynamicp;

int             ImageNumber = 1;


/*
 * Dynamic data.
 */
Dynamic dynamic;

/*
 * necessary for RSP tasks:
 */
#if __GNUC__
u64 dram_stack[SP_DRAM_STACK_SIZE64] __attribute__((aligned (16)));	/* used for matrix stack */
u64 rdp_output[4096*16] __attribute__((aligned (16)));		/* RSP writes back RDP data */

#else

u64 dram_stack[SP_DRAM_STACK_SIZE64];
u64 rdp_output[4096*16];

#endif
    
u64 rdp_output_len;			/* RSP writes back size of RDP data */
/*
 * Task descriptor.
 */
OSTask	tlist =
{
    M_GFXTASK,			/* task type */
    OS_TASK_DP_WAIT,		/* task flags */
    NULL,			/* boot ucode pointer (fill in later) */
    0,				/* boot ucode size (fill in later) */
    NULL,			/* task ucode pointer (fill in later) */
    SP_UCODE_SIZE,		/* task ucode size */
    NULL,			/* task ucode data pointer (fill in later) */
    SP_UCODE_DATA_SIZE,		/* task ucode data size */
    &(dram_stack[0]),		/* task dram stack pointer */
    SP_DRAM_STACK_SIZE8,	/* task dram stack size */
    &(rdp_output[0]),		/* task output buffer ptr (not always used) */
    &rdp_output_len,		/* task output buffer size ptr */
    NULL,			/* task data pointer (fill in later) */
    0,				/* task data size (fill in later) */
    NULL,			/* task yield buffer ptr (not used here) */
    0				/* task yield buffer size (not used here) */
};

Gfx		*glistp;	/* global for test case procs */
    
/*
 * global variables
 */
static int	rdp_DRAM_io = 0;
static int      OutputRDP   = 0;
static int	debugflag   = 0;
static int      draw_buffer = 0;
static int      verbose     = 0;
static int      FrameRate   = 1;

float  theta                = 0;
float  TranslateHorizontal  = 0;
float  TranslateVertical    = 0;

void    *cfb_ptrs[2];

/* copied out of simple's misc.c */

static int myatoi(char *str)
{
    int		log10[5], logn = 0, val = 0, i, pow10 = 1;

    if (str == NULL || *str == '\0')
	return(-2);

    while (*str != '\0') 
	{
	    if (!(*str == '0' ||
		  *str == '1' ||
		  *str == '2' ||
		  *str == '3' ||
		  *str == '4' ||
		  *str == '5' ||
		  *str == '6' ||
		  *str == '7' ||
		  *str == '8' ||
		  *str == '9')) 
		{
		    logn = 0;
		    break;
		}
	    
	    log10[logn++] = *str - '0';
	    str++;
	}

    if (logn == 0)
	return(-3);
    
    for (i=logn-1; i>= 0; i--) 
	{
	    val += log10[i] * pow10;
	    pow10 *= 10;
	}

    return (val);
}

void parse_args(char *argstring)
{
  int		argc = 1;
  char	*arglist[32], **argv = arglist;	/* max 32 args */
  char	*ptr;

  if (argstring == NULL || argstring[0] == '\0')
    return;

  /* re-organize argstring to be like main(argv,argc) */

  ptr = argstring;
  while (*ptr != '\0') {
    while (*ptr != '\0' && (*ptr == ' ')) 
      {
	*ptr = '\0';
	ptr++;
      }
    if (*ptr != '\0')
      arglist[argc++] = ptr;
    while (*ptr != '\0' && (*ptr != ' ')) 
      {
	ptr++;
      }
  }

  /* process the arguments: */
  while ((argc > 1) && (argv[1][0] == '-')) 
    {
      switch(argv[1][1]) 
	{
	case 'd':
	  debugflag   = 1;
	  break;

	case 'r':
	  rdp_DRAM_io = 1;
	  break;

	case 'v':
	  verbose     = 1;
	  break;
	  
	default:
	  break;
	}
      
      argc--;
      argv++;
    }
}


OSPiHandle	*handler;

void
boot(void)
{
    int i;
    u32 *argp;
    u32 argbuf[16];

    /* notice that you can't call rmonPrintf() until you set
     * up the rmon thread.
     */
    
    osInitialize();

    handler = osCartRomInit();

    argp = (u32 *)RAMROM_APP_WRITE_ADDR;
    for (i=0; i<sizeof(argbuf)/4; i++, argp++) 
      {
	osEPiReadIo(handler, (u32)argp, &argbuf[i]); /* Assume no DMA */
      }

    parse_args((char *) argbuf);
    
    osCreateThread(&idleThread, 1, idle, (void *)0,
		   idleThreadStack+STACKSIZE/sizeof(u64), 10);
    osStartThread(&idleThread);

    /* never reached */
}

static void
idle(void *arg)
{
    /* Initialize video */
    osCreateViManager(OS_PRIORITY_VIMGR);
    osViSetMode(&osViModeTable[OS_VI_NTSC_LAN2]);
    
    /*
     * Start PI Mgr for access to cartridge
     */
    osCreatePiManager((OSPri)OS_PRIORITY_PIMGR, &PiMessageQ, PiMessages, 
		      NUM_PI_MSGS);
    
    /*
     * Start RMON for debugging & data xfer (make sure to start 
     * PI Mgr first)
     */
    osCreateThread(&rmonThread, 0, rmonMain, (void *)0,
		   (void *)(rmonStack+RMON_STACKSIZE/8), 
		   (OSPri) OS_PRIORITY_RMON );
    osStartThread(&rmonThread);

    /*
     * at this point, AND NOT BEFORE, we can now do an
     * rmonPrintf()
     */
    
    /*
     * Create main thread
     */
    osCreateThread(&mainThread, 3, main, arg,
		   mainThreadStack+STACKSIZE/sizeof(u64), 10);
    
    if (!debugflag)
	osStartThread(&mainThread);

    /*
     * Become the idle thread
     */
    osSetThreadPri(0, 0);

    for (;;);
}

void CreateMessageQueues(void)
{
  osCreateMesgQueue(&dmaMessageQ, &dmaMessageBuf, 1);
  
  osCreateMesgQueue(&rspMessageQ, &rspMessageBuf, 1);
  osSetEventMesg(OS_EVENT_SP, &rspMessageQ, dummyMessage);
  
  osCreateMesgQueue(&rdpMessageQ, &rdpMessageBuf, 1);
  osSetEventMesg(OS_EVENT_DP, &rdpMessageQ, dummyMessage);
  
  osCreateMesgQueue(&retraceMessageQ, &retraceMessageBuf, 1);
  osViSetEvent(&retraceMessageQ, dummyMessage, FrameRate);  
}

void DMAStaticSegment(void)
{
  /* Stick the static segment right after the code/data segment */

  staticSegment = _codeSegmentEnd;

  dmaIOMessageBuf.hdr.pri      = OS_MESG_PRI_NORMAL;
  dmaIOMessageBuf.hdr.retQueue = &dmaMessageQ;
  dmaIOMessageBuf.dramAddr     = staticSegment;
  dmaIOMessageBuf.devAddr      = (u32)_staticSegmentRomStart;
  dmaIOMessageBuf.size         = _staticSegmentRomEnd-_staticSegmentRomStart;

  osEPiStartDma(handler, &dmaIOMessageBuf, OS_READ);
  
  /* Wait for DMA to finish */
  (void)osRecvMesg(&dmaMessageQ, &dummyMesg, OS_MESG_BLOCK);  
}

void SetupSegments(void)
{
  /* Tell RCP where each segment is */

  gSPSegment(glistp++, 0, 0x0);   
  gSPSegment(glistp++, STATIC_SEGMENT, osVirtualToPhysical(staticSegment));
}

void CreateTaskStructure(int type)
{
  /* Build graphics task */

  tlistp->t.ucode_boot = (u64 *) rspbootTextStart;
  tlistp->t.ucode_boot_size = (u32)rspbootTextEnd - (u32)rspbootTextStart;

  /* choose which ucode to run */

  if (rdp_DRAM_io) 
    {
      /* re-direct output to DRAM: */
      tlistp->t.ucode      = (u64 *) gspFast3D_dramTextStart;
      tlistp->t.ucode_data = (u64 *) gspFast3D_dramDataStart; 
    } 
  else 
    {
      /* RSP output over XBUS to RDP: */
      tlistp->t.ucode      = (u64 *) gspFast3DTextStart;
      tlistp->t.ucode_data = (u64 *) gspFast3DDataStart;
    }	
  
  /* initial display list: */
  tlistp->t.data_ptr = (u64 *) dynamicp->glist;
}

static void SwapViBuffer(void)
{
  /* setup to swap buffers */
  osViSwapBuffer(cfb_ptrs[draw_buffer]); 
  
  /* Make sure there isn't an old retrace in queue */
  if (MQ_IS_FULL(&retraceMessageQ))
    (void)osRecvMesg(&retraceMessageQ, NULL, OS_MESG_BLOCK);
  
  /* Wait for Vertical retrace to finish swap buffers */
  (void)osRecvMesg(&retraceMessageQ, NULL, OS_MESG_BLOCK);
  draw_buffer ^= 1;
}


static void doPolyFuncs(void)
{
  /* Setup display modes antialiased in 1 cycle */

  gDPSetRenderMode(glistp++, G_RM_ZB_OPA_SURF, G_RM_ZB_OPA_SURF2);

  if ((ImageNumber >= 1) && (ImageNumber <= 31))
    {
      testCaseLookAtHilite(ImageNumber-1);
    }
  else
    {
      rmonPrintf("ERROR: test case %d out of range \n", ImageNumber);
    }    
}

static void InitDisplayLists(void)
{
  /* pointers to build the display list */
  glistp = dynamicp->glist;
  
  SetupSegments();
  
  /* Initialize RDP state */
  gSPDisplayList(glistp++, rdpinit_dl);
  
  /* Initialize RSP state */
  gSPDisplayList(glistp++, rspinit_dl);  
}

static void ClearFrameBuffer(void)
{
  /* Clear color framebuffer */

  gDPSetCycleType(glistp++, G_CYC_FILL);
  gDPSetColorImage(glistp++, G_IM_FMT_RGBA, G_IM_SIZ_32b, SCREEN_WD, 
		    OS_K0_TO_PHYSICAL(cfb_ptrs[draw_buffer]));

  gDPSetFillColor(glistp++, (0x40 << 24) | (0x40 << 16) | (0x40 << 8) | (0xff << 0)); 

  gDPFillRectangle(glistp++, 0, 0, SCREEN_WD-1, SCREEN_HT-1);
  gDPPipeSync(glistp++);

  gDPSetFillColor(glistp++, (0x00 << 24) | (0x00 << 16) | (0x00 << 8) | (0xff << 0)); 

  gDPFillRectangle(glistp++, 20, 20, SCREEN_WD-20, SCREEN_HT-20); 
  gDPPipeSync(glistp++);

  gDPSetCycleType(glistp++, G_CYC_1CYCLE);  
}

static void ClearZBuffer (void)
{
  if (verbose) rmonPrintf("Clearing zbuffer \n");

  gDPSetColorImage(glistp++, G_IM_FMT_RGBA, G_IM_SIZ_16b, 
		   SCREEN_WD, OS_K0_TO_PHYSICAL(zbuffer));

  gDPPipeSync(glistp++);
  gDPSetCycleType(glistp++, G_CYC_FILL);

  gDPSetFillColor(glistp++, 
		  GPACK_ZDZ(G_MAXFBZ, 0) << 16 | GPACK_ZDZ(G_MAXFBZ, 0));

  gDPFillRectangle(glistp++, 0, 0, SCREEN_WD-1, SCREEN_HT-1);

  gDPPipeSync(glistp++);
}

/* stupid procedure name... */
static void CleanupAndSendDisplayList(int MicrocodeType)
{
  gDPFullSync(glistp++);
  gSPEndDisplayList(glistp++);
	
  assert((glistp-dynamicp->glist) < GLIST_LEN);
	
  tlistp->t.data_size = (u32)((glistp - dynamicp->glist) * sizeof(Gfx));
	
  /* Write back dirty cache lines that need to be read by the RCP */
  osWritebackDCache(&dynamic, sizeof(dynamic));
	
  /* start up the RSP task */
  CreateTaskStructure(MicrocodeType);
  osSpTaskStart(tlistp);
	
  /* wait for SP completion */
  (void)osRecvMesg(&rspMessageQ, NULL, OS_MESG_BLOCK);
	
  if (rdp_DRAM_io) 
    {
      /* Send the DP display list to the DP */
	  
      osDpSetNextBuffer(&(rdp_output[0]), rdp_output_len);
    }
	
  (void)osRecvMesg(&rdpMessageQ, NULL, OS_MESG_BLOCK);
}


static void doLinePoly(void *arg)
{
  /* Main game loop */
  while (1) 
    {
      if (verbose) rmonPrintf("In doLinePoly \n");

      ReadController();

      if (verbose) rmonPrintf("Theta -> %f\tHorizontal -> %f\tVertical -> %f \n",
			      theta, TranslateHorizontal, TranslateVertical);

      /* Do poly stuff */
      InitDisplayLists();
      ClearZBuffer(); 
      ClearFrameBuffer();

      doPolyFuncs(); 
      CleanupAndSendDisplayList(FAST3D);	

      if (OutputRDP)
	{
	  rmonPrintf("Going to hang \n");
	  while(1) {};
	}

      SwapViBuffer();
    }
}

typedef struct
{
  float     spec1Dir[3];
  float     spec2Dir[3];

  union
  {
    Lights1   *Light1;
    Lights2   *Light2;
    Lights7   *Light7;
  } Lights;

  Gfx       *DisplayList;
  u8        PrimColor[3];
  u8        EnvColor[3];
  
  float     LookFrom[3];
  float     LookAt[3];
  float     LookUp[3];

  Gfx       *SphereDL;

  float     fovy;

} SpecStruct;

SpecStruct SpecVals[31] =
{
  /* 0  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &ambientL1,  Asquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33, 
  /* 1  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &ambientL2,  Asquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33, 
  /* 2  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &ambientL3,  Asquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33, 
  /* 3  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffuseL1,  Dsquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 4  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffuseL2,  Dsquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 5  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffuseL3,  Dsquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 6  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffuseL4,  Dsquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 7  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffAmbL1,  DAsquare1,   255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 8  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffAmbL2,  DAsquare1,   255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 9  */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffAmbL3,  DAsquare1,   255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 10 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &specL1,     Ssquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 11 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &specL2,     Ssquare1,    255,   0, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 12 */ -90.000, -90.000,    0.000,    0.000,   0.000, 127.000, (Lights1 *) &specL3,     Ssquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 13 */  90.000,  90.000,    0.000,    0.000,   0.000, 127.000, (Lights1 *) &specL4,     Ssquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 14 */   0.000,   0.000, -127.000,    0.000,   0.000, 127.000, (Lights1 *) &specL5,     Ssquare1,    255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 15 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &ADSL1,      ADSsquare1,    0,  55, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 16 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &ADSL2,      ADSsquare1,    0, 155, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 17 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &ADSL3,      ADSsquare1,  255, 255, 255,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 18 */ -64.000,   0.000,   32.000,    0.000,   0.000, 127.000, (Lights1 *) &MSlitc1,    MSsquare1,     0, 255,   0,   255,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 19 */   0.000,   0.000,  127.000,  -64.000,   0.000,  32.000, (Lights1 *) &MSlitc1,    NSsquare1,   255,   0,   0,     0, 255,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 20 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffuseL71, DsquareN,      0,   0,   0,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 21 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffuseL72, DsquareN,      0,   0,   0,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 22 */   0.000,   0.000,  127.000,    0.000,   0.000, 127.000, (Lights1 *) &diffuseL73, DsquareN,      0,   0,   0,     0,   0,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 23	*/   0.000,   0.000,  127.000,  -64.000,   0.000,  32.000, (Lights1 *) &MDSlitc1,   NDSsquare1,  255,   0,   0,     0, 255,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 24	*/   0.000,   0.000,  127.000,  -64.000,   0.000,  32.000, (Lights1 *) &MDSlitc2,   NDSsquare1,  255,   0,   0,     0, 255,   0,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6b,  33,
  /* 25 */  64.377, 106.816,  -23.976,   -3.337,  51.242,  49.831, (Lights1 *) &SDTlitc,    SDTsquare1,  255,   0,   0,     0, 255,   0,  312.040,  372.323,  -56.635,   160.000, 120.000,   0.000,   -0.806016,   0.384838, -0.449709,  light6b,  33, 
  /* 27 */ -90.000, -90.000,    0.000,   90.000,  90.000,   0.000, (Lights1 *) &HRlitc,     HRsquare1,     0,   0, 255,     0,   0, 255,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6c,  33,
  /* 28 */ -90.000, -90.000,    0.000,   90.000,  90.000,   0.000, (Lights1 *) &SDATlitc,   SDATsquare1, 255,   0,   0,   255,   0, 255,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6d1, 33,
  /* 29 */ -90.000, -90.000,    0.000,   90.000,  90.000,   0.000, (Lights1 *) &SDATlitc,   SDATsquare1, 255,   0,   0,   255,   0, 255,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6d2, 63,
  /* 30 */ -90.000, -90.000,    0.000,   90.000,  90.000,   0.000, (Lights1 *) &SDATlitc,   SDATsquare1, 255,   0,   0,   255,   0, 255,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6d3, 63,
  /* 31 */ -90.000, -90.000,    0.000,   90.000,  90.000,   0.000, (Lights1 *) &SDATlitc,   SDATsquare1, 255,   0,   0,   255,   0, 255,  160.000,  120.000,  300.000,   160.000, 120.000,   0.000,    0.000000,   1.000000,  0.000000,  light6d4, 63,
};

void testCaseLookAtHilite(int TestNumber)
{
  static float	theta = 0.0;
  Mtx m,n;
  u16   		perspNorm;
  
  guPerspective(&dynamicp->projection,&perspNorm,
		SpecVals[TestNumber].fovy, 320.0/240.0, 1, 500, 1.0);
  
  guLookAtHilite(&(dynamicp->viewing), 
		 &(dynamicp->lookat[0]), 
		 &(dynamicp->hilite[0]),
		 
		 SpecVals[TestNumber].LookFrom[0],
		 SpecVals[TestNumber].LookFrom[1],
		 SpecVals[TestNumber].LookFrom[2],
		 
		 SpecVals[TestNumber].LookAt[0],
		 SpecVals[TestNumber].LookAt[1],
		 SpecVals[TestNumber].LookAt[2],
		 
		 SpecVals[TestNumber].LookUp[0],
		 SpecVals[TestNumber].LookUp[1],
		 SpecVals[TestNumber].LookUp[2],
		 
		 SpecVals[TestNumber].spec1Dir[0],  
		 SpecVals[TestNumber].spec1Dir[1],
		 SpecVals[TestNumber].spec1Dir[2],  
		 
		 SpecVals[TestNumber].spec2Dir[0],  
		 SpecVals[TestNumber].spec2Dir[1],
		 SpecVals[TestNumber].spec2Dir[2],  

		 32,32);
    
  guRotate(&dynamicp->modeling, theta, 0.0, 0.0, 1.0);

  gSPMatrix(glistp++, OS_K0_TO_PHYSICAL(&(dynamicp->projection)),
	    G_MTX_PROJECTION|G_MTX_LOAD|G_MTX_NOPUSH);
  
  gSPMatrix(glistp++, OS_K0_TO_PHYSICAL(&(dynamicp->viewing)),
	    G_MTX_PROJECTION|G_MTX_MUL|G_MTX_NOPUSH);
  
  gSPMatrix(glistp++, OS_K0_TO_PHYSICAL(&(dynamicp->modeling)),
	    G_MTX_MODELVIEW|G_MTX_LOAD|G_MTX_NOPUSH);
  
  gSPLookAt(glistp++, &(dynamicp->lookat[0]));
  
  gSPDisplayList(glistp++, SpecVals[TestNumber].DisplayList);
  
  
  gSPPerspNormalize(glistp++, perspNorm);
  
  gDPSetHilite1Tile(glistp++,G_TX_RENDERTILE,dynamicp->hilite,32,32); 
  gDPSetHilite2Tile(glistp++,G_TX_RENDERTILE+1,dynamicp->hilite,32,32);

  if (TestNumber > 25)
    {
      gSPSetLights2(glistp++, (*SpecVals[TestNumber].Lights.Light2));
    }
  else if (TestNumber < 20)
    {
      gSPSetLights1(glistp++, (*SpecVals[TestNumber].Lights.Light1));
    }
  else
    {
      gSPSetLights7(glistp++, (*SpecVals[TestNumber].Lights.Light7)); 
    }
  
  gDPSetPrimColor(glistp++, 0, 0, 
		  SpecVals[TestNumber].PrimColor[0],
		  SpecVals[TestNumber].PrimColor[1],
		  SpecVals[TestNumber].PrimColor[2], 
		  255);
  
  gDPSetEnvColor(glistp++,
		 SpecVals[TestNumber].EnvColor[0],
		 SpecVals[TestNumber].EnvColor[1],
		 SpecVals[TestNumber].EnvColor[2], 
		 255);
  
  gSPDisplayList(glistp++, SpecVals[TestNumber].SphereDL);
  
  gDPFullSync(glistp++);
}


static void main(void *arg)
{
  tlistp = &tlist;
  dynamicp = &dynamic;
  cfb_ptrs[0] = cfb_32_a; 
  cfb_ptrs[1] = cfb_32_b; 

  initControllers();
  CreateMessageQueues();
  DMAStaticSegment();    
  doLinePoly(arg); 
}