/*============================================================================

   NINTENDO64 TEST PROGRAM 2 by K.Ohki

   graphic_01.c
============================================================================*/
#include <ultra64.h>
#include <PR/ramrom.h>
#include <assert.h>

#include "def.h"
#include "vram.h"
#include "segment.h"
#include "message.h"
#include "nnsched.h"
#include "controller.h"
#include "graphic.h"
#include "main01.h"
#include "audio.h"


/*
   ブレンダーのレンダリングモードの定義
   半透明ライン、アンチエイリアスなし、Z-Buffer使用しないモード
*/
#define RM_XLU_LINE(clk)                                     \
        IM_RD | CVG_DST_CLAMP | CVG_X_ALPHA |           \
        ALPHA_CVG_SEL | FORCE_BL | ZMODE_OPA |                  \
        GBL_c##clk(G_BL_CLR_IN, G_BL_A_IN, G_BL_CLR_MEM, G_BL_1MA)
/* 半透明ライン、アンチエイリアスなし、Z-Buffer使用モード */
#define RM_ZB_XLU_LINE(clk)                                     \
        Z_CMP | IM_RD | CVG_DST_CLAMP | CVG_X_ALPHA |           \
        ALPHA_CVG_SEL | FORCE_BL | ZMODE_OPA |                  \
        GBL_c##clk(G_BL_CLR_IN, G_BL_A_IN, G_BL_CLR_MEM, G_BL_1MA)

#define G_RM_XLU_LINE     RM_XLU_LINE(1)
#define G_RM_XLU_LINE2    RM_XLU_LINE(2)
#define G_RM_ZB_XLU_LINE  RM_ZB_XLU_LINE(1)
#define G_RM_ZB_XLU_LINE2 RM_ZB_XLU_LINE(2)

/* 座標軸のラインの頂点 */
Vtx line_vtx[] = {
  { -20,    0,    0,   0,   0,   0, 0xff, 0x00, 0x00, 0xff},
  {  20,    0,    0,   0,   0,   0, 0xff, 0x00, 0x00, 0xff},
  {    0,  20,    0,   0,   0,   0, 0x00, 0xff, 0x00, 0xff},
  {    0, -20,    0,   0,   0,   0, 0x00, 0xff, 0x00, 0xff},
  {    0,   0,   20,   0,   0,   0, 0x00, 0x00, 0xff, 0xff},
  {    0,   0,  -20,   0,   0,   0, 0x00, 0x00, 0xff, 0xff},
};

/* 座標軸のラインのディスプレイリスト */
Gfx line_dl[] = {
  gsDPPipeSync(),
  gsDPSetScissor(G_SC_NON_INTERLACE, 0,0, 319,239),
  gsDPSetCycleType(G_CYC_1CYCLE),
  gsSPClearGeometryMode((G_SHADE|G_SHADING_SMOOTH|G_LIGHTING|G_TEXTURE_GEN|G_TEXTURE_GEN_LINEAR|G_CULL_BOTH|G_FOG)),
  gsDPSetRenderMode(G_RM_ZB_XLU_LINE, G_RM_ZB_XLU_LINE2),
  gsSPSetGeometryMode( G_ZBUFFER | G_SHADE),
  gsSPClipRatio(FRUSTRATIO_6),
  gsDPSetCombineMode(G_CC_SHADE, G_CC_SHADE),
  gsSPVertex(&line_vtx, 6, 0),
  gsSPLineW3D(0, 1, 0, 0),
  gsSPLineW3D(2, 3, 0, 0),
  gsSPLineW3D(4, 5, 0, 0),
  gsSPEndDisplayList(),
};

/* パフォーマンスメータの枠の頂点 */
Vtx perfline_vtx[] = {
  {   40,  20,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {   40,  40,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  120,  20,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  120,  40,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  200,  20,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  200,  40,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  280,  20,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  280,  40,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {   40,  40,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  280,  40,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {   40,  20,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
  {  280,  20,   0,   0,   0,   0, 0xff, 0xff, 0xff, 0x80},
};

/* パフォーマンスメータの頂点 */
Vtx meter_vtx[60];

/* パフォーマンスメータの枠の描画 */
Gfx perfline_dl[] = {
  gsDPPipeSync(),
  gsDPSetScissor(G_SC_NON_INTERLACE, 0,0, 319,239),
  gsDPSetCycleType(G_CYC_1CYCLE),
  gsSPClearGeometryMode((G_SHADE|G_SHADING_SMOOTH|G_LIGHTING|G_TEXTURE_GEN|G_TEXTURE_GEN_LINEAR|G_CULL_BOTH|G_FOG)),
  gsDPSetRenderMode(G_RM_XLU_LINE, G_RM_XLU_LINE2),
  gsSPSetGeometryMode( G_SHADE),
  gsDPSetCombineMode(G_CC_SHADE, G_CC_SHADE),
  gsSPVertex(&perfline_vtx, 12, 0),
  gsSPLine3D( 0, 1, 0),
  gsSPLine3D( 2, 3, 0),
  gsSPLine3D( 4, 5, 0),
  gsSPLine3D( 6, 7, 0),
  gsSPLine3D( 8, 9, 0),
  gsSPLine3D(10,11, 0),
  gsSPEndDisplayList(),
};


  
void Model_Fiter(CFiter*);
void View_Matrix(Dynamic *);
void Model_bullet(CFiter *);
void Perf_line(void);


extern Gfx bullet_dl[];
extern Gfx fiter_1_dl[];
extern CFiter fiter[];
extern u32 threadpri_flag;

/*-----------------------------------------------------------------------------
  graphic01

-----------------------------------------------------------------------------*/
void graphic_01(void)
{

  static Mtx line_mtx;
  Dynamic* dynamic_ptr;
  NNScTask *t;


  /* 
     ディスプレイリストバッファ・タスクバッファの指定
  */
  dynamic_ptr = &gfx_dynamic[gfx_gtask_no];
  glist_ptr = &gfx_glist[gfx_gtask_no][0];
  t = &gfx_task[gfx_gtask_no];

  /* RSPとRDPの設定 */
  gfxRCPInit();

  /* フレームバッファとZバッファのクリア */
  gfxClearCfb();

  /* end top-level display list */
  gDPFullSync(glist_ptr++);
  gSPEndDisplayList(glist_ptr++);

  /* Flush the dynamic segmnet */
  osWritebackDCacheAll();

  /* グラフィックタスクスタート */
  gfxTaskStart(t, &gfx_glist[gfx_gtask_no][0],
	       (s32)(glist_ptr - gfx_glist[gfx_gtask_no]) * sizeof (Gfx),
	       GFX_GSPCODE_F3DEX2, 0);

/*
   ここでグラフィックスレッドのプライオリティを下げる
   普通はGFX_THREAD_PRIなのでなんの効果もない。

   Zトリガーを押している間はプライオリティをあげて
   リトレースメッセージ待ちをおこなっているので、
   リトレースメッセージが来ればまずグラフィックタスクを作成し
   RSP-RDPを動かしてZ-Buffer,FrameBufferのクリアを行い、
   そこ後オーディオタスクを作成するようにプライオリティを下げている。
   こうすると、CPUがオーディオタスクを作成している時間を利用できる。
*/
  osSetThreadPri(NULL, GRAPHIC_THREAD_PRI);


  /* 
     ディスプレイリストバッファ・タスクバッファの指定
  */
  dynamic_ptr = &gfx_dynamic[gfx_gtask_no];
  glist_ptr = &gfx_glist[gfx_gtask_no][0];
  t = &gfx_task[gfx_gtask_no];

  /* RSPとRDPの設定 */
  gfxRCPInit();

  /* 投影マトリックスの計算と設定 */
  View_Matrix(dynamic_ptr);

  /* フォグの設定 */
  gSPFogPosition(glist_ptr++,500,1000);
  gDPSetFogColor(glist_ptr++, 0, 0, 0, 255);

  /* モデルの描画 */
  Model_Fiter(&fiter[0]);  /* 1コン自機 */
  Model_Fiter(&fiter[1]);  /* 2コン自機 */
  Model_bullet(&fiter[0]); /* 1コン弾 */
  Model_bullet(&fiter[1]); /* 2コン弾 */

  /* end top-level display list */
  gDPFullSync(glist_ptr++);
  gSPEndDisplayList(glist_ptr++);

  /* Flush the dynamic segmnet */
  osWritebackDCacheAll();

  /* グラフィックタスクスタート */
  gfxTaskStart(t, &gfx_glist[gfx_gtask_no][0],
	       (s32)(glist_ptr - gfx_glist[gfx_gtask_no]) * sizeof (Gfx),
	       GFX_GSPCODE_F3DEX2, 0);


  /* 
     ディスプレイリストバッファ・タスクバッファの指定
  */
  dynamic_ptr = &gfx_dynamic[gfx_gtask_no];
  glist_ptr = &gfx_glist[gfx_gtask_no][0];
  t = &gfx_task[gfx_gtask_no];
 
  /* RSPとRDPの設定 */
  gfxRCPInit();

  /* 投影マトリックスの計算と設定 */
  View_Matrix(dynamic_ptr);

  /* モデルの描画 */
  guMtxIdent(&dynamic_ptr->modeling);
  gSPMatrix(glist_ptr++, OS_K0_TO_PHYSICAL(&dynamic_ptr->modeling),
	    G_MTX_MODELVIEW | G_MTX_LOAD | G_MTX_NOPUSH);

  /* X,Y,Z軸の表示 */
  gSPDisplayList(glist_ptr++, OS_K0_TO_PHYSICAL(line_dl));

  /* パフォーマンスメータの表示 */
  Perf_line();

  /* end top-level display list */
  gDPFullSync(glist_ptr++);
  gSPEndDisplayList(glist_ptr++);

  /* Flush the dynamic segmnet */
  osWritebackDCacheAll();

  /* グラフィックタスクスタート */
  gfxTaskStart(t, gfx_glist[gfx_gtask_no],
	       (s32)(glist_ptr - gfx_glist[gfx_gtask_no]) * sizeof (Gfx),
	       GFX_GSPCODE_L3DEX2, NN_SC_SWAPBUFFER);

  /*
     Zトリガーを押されている間このスレッドのプライオリティを
     オーディオスレッド以上にする。
     次のリトレースでグラフィックスレッドを先に動かせるため。
  */
  if(threadpri_flag){
    osSetThreadPri(NULL, AUDIO_THREAD_PRI+5);
  }
}


/*-----------------------------------------------------------------------------
  モデル表示
-----------------------------------------------------------------------------*/
void Model_Fiter(CFiter *fiter)
{
  /* セグメントレジスタの設定 */
  gSPSegment(glist_ptr++, STATIC_SEGMENT, osVirtualToPhysical(fiter->dlist_buf));

  /* モデル座標系の計算 */
  guScale(&fiter->model_size, fiter->pos.size, fiter->pos.size, fiter->pos.size);

  guTranslate(&fiter->model_trans, 0.0, fiter->pos.y, fiter->pos.z);
  
  guRotate(&fiter->model_rotate, fiter->pos.x, 0.0, 0.0, 1.0);


  /* モデルマトリックスの設定 */
  gSPMatrix(glist_ptr++, &fiter->model_size, 
	    G_MTX_MODELVIEW | G_MTX_LOAD | G_MTX_NOPUSH);
  gSPMatrix(glist_ptr++, &fiter->model_rotate, 
	    G_MTX_MODELVIEW | G_MTX_MUL | G_MTX_NOPUSH);
  gSPMatrix(glist_ptr++, &fiter->model_trans, 
	    G_MTX_MODELVIEW | G_MTX_MUL | G_MTX_NOPUSH);

  /* モデルのディスプレイリスト */
  gSPDisplayList(glist_ptr++, fiter->dlist_ptr);
}

/*-----------------------------------------------------------------------------
  弾の表示
-----------------------------------------------------------------------------*/
void Model_bullet(CFiter *fiter)
{
  int cnt;
  CBullet* bullet_ptr;
  float size;

  size = fiter->pos.size;
  for(cnt = 0; cnt < FITER_BULLET_NUM; cnt++){
    bullet_ptr = &fiter->bullet[cnt];
    if(bullet_ptr->flag == FITER_BULLET_FLAG_FIRE){
      guScale(&bullet_ptr->model_size, size, size, size);
      guTranslate(&bullet_ptr->model_trans, 0.0,
		  bullet_ptr->pos.y, bullet_ptr->pos.z);
      guRotate(&bullet_ptr->model_rotate, bullet_ptr->pos.x, 0.0, 0.0, 1.0);

      gSPMatrix(glist_ptr++, &bullet_ptr->model_size, 
		G_MTX_MODELVIEW | G_MTX_LOAD | G_MTX_NOPUSH);
      gSPMatrix(glist_ptr++, &bullet_ptr->model_rotate, 
		G_MTX_MODELVIEW | G_MTX_MUL | G_MTX_NOPUSH);
      gSPMatrix(glist_ptr++, &bullet_ptr->model_trans, 
		G_MTX_MODELVIEW | G_MTX_MUL | G_MTX_NOPUSH);

      gSPDisplayList(glist_ptr++, bullet_dl);
    }
  }
}
/*-----------------------------------------------------------------------------
  ビューマトリクスの設定
-----------------------------------------------------------------------------*/
void View_Matrix(Dynamic *dynamic_ptr)
{
  float rot_pitch[4][4];
  float rot_yaw[4][4];
  u16   perspNorm;

  guRotateF(rot_pitch, lookat.pitch, 1.0, 0.0, 0.0);
  guRotateF(rot_yaw, lookat.yaw, 0.0, 1.0, 0.0);
  guMtxCatF(rot_pitch, rot_yaw, rot_yaw);
  guMtxXFMF(rot_yaw,
	    0.0, 0.0, lookat.dist,
	    &lookat.eye_x, &lookat.eye_y, &lookat.eye_z);

  guPerspective(&dynamic_ptr->projection, &perspNorm,
		33, 320.0/240.0, 20, 1000, 1.0);

  guLookAt(&dynamic_ptr->viewing,
		  lookat.eye_x, lookat.eye_y, lookat.eye_z,
		  lookat.at_x, lookat.at_y, lookat.at_z,
		  lookat.up_x, lookat.up_y, lookat.up_z);
  gSPPerspNormalize(glist_ptr++, perspNorm);

  gSPMatrix(glist_ptr++, &(dynamic_ptr->projection), 
	    G_MTX_PROJECTION | G_MTX_LOAD | G_MTX_NOPUSH);
  gSPMatrix(glist_ptr++, &(dynamic_ptr->viewing), 
	    G_MTX_PROJECTION | G_MTX_MUL | G_MTX_NOPUSH);
  gDPPipeSync(glist_ptr++);
}

/*-----------------------------------------------------------------------------
  パフォーマンスメータの頂点行列の設定
-----------------------------------------------------------------------------*/
void vtxset(Vtx* vtx_ptr, short x, short y, short z,
	    u8 red, u8 green, u8 blue, u8 alpha)
{
  vtx_ptr->v.ob[0] = x;
  vtx_ptr->v.ob[1] = y;
  vtx_ptr->v.ob[2] = z;
  vtx_ptr->v.flag  = 0;
  vtx_ptr->v.tc[0] = 0;
  vtx_ptr->v.tc[1] = 0;
  vtx_ptr->v.cn[0] = red;
  vtx_ptr->v.cn[1] = green;
  vtx_ptr->v.cn[2] = blue;
  vtx_ptr->v.cn[3] = alpha;
}

/*-----------------------------------------------------------------------------
   パフォーマンスメーターの描画
-----------------------------------------------------------------------------*/
void Perf_line(void)
{
#ifdef NN_SC_PERF
  static Mtx perf_mtx;
  static Mtx line_mtx;
  static Mtx view_mtx;
  int cnt;
  int vtx_index;
  int vtx_rest;
  short x0,x1;

  /*  パフォーマンスメータの視点設定 */
     
     
  guOrtho(&perf_mtx,
	  0.0F, (float)SCREEN_WD,
	  0.0F, (float)SCREEN_HT,
	  -1.0F, 10.0F, 1.0F);

  guLookAt(&view_mtx,
	   0.0, 0.0, 1.0,
	   0.0, 0.0, 0.0,
	   0.0, 1.0, 0.0);

  gSPMatrix(glist_ptr++, &perf_mtx, 
	    G_MTX_PROJECTION | G_MTX_LOAD | G_MTX_NOPUSH);
  gSPMatrix(glist_ptr++, &view_mtx,
	    G_MTX_PROJECTION | G_MTX_MUL | G_MTX_NOPUSH);

  guMtxIdent(&line_mtx);
  gSPMatrix(glist_ptr++, OS_K0_TO_PHYSICAL(&line_mtx),
	    G_MTX_MODELVIEW | G_MTX_LOAD | G_MTX_NOPUSH);

  vtx_index = 0;

  /* オーディオタスクのパフォーマンス表示 */
  for(cnt = 0; cnt < nnsc_perf_ptr->autask_cnt; cnt++){

    x0 = nnsc_perf_ptr->autask_stime[cnt] * 80/16666 + 40;
    vtxset( &meter_vtx[vtx_index], x0, 36, 0, 0xff, 0x00, 0x00, 0x80);
    vtx_index++;
    x0 = nnsc_perf_ptr->autask_etime[cnt] * 80/16666 + 40;
    vtxset( &meter_vtx[vtx_index], x0, 36, 0, 0xff, 0x00, 0x00, 0x80);
    vtx_index++;

  }

  /* グラフィックタスクのパフォーマンス表示 */
  for(cnt = 0; cnt < nnsc_perf_ptr->gtask_cnt; cnt++){

    /* RSPの計測結果 */
    x0 = nnsc_perf_ptr->gtask_stime[cnt] * 80/16666 + 40;
    vtxset( &meter_vtx[vtx_index], x0, 30, 0, 0x00, 0xff, 0x00, 0x80);
    vtx_index++;

    x1 = nnsc_perf_ptr->rsp_etime[cnt] * 80/16666 + 40;
    vtxset( &meter_vtx[vtx_index], x1, 30, 0, 0x00, 0xff, 0x00, 0x80);
    vtx_index++;

    /* RDPの計測結果 */
    vtxset( &meter_vtx[vtx_index], x0, 24, 0, 0xff, 0xff, 0x00, 0x80);
    vtx_index++;

    x1 = nnsc_perf_ptr->rdp_etime[cnt] * 80/16666 + 40;
    vtxset( &meter_vtx[vtx_index], x1, 24, 0, 0xff, 0xff , 0x00, 0x80);
    vtx_index++;

  }

  gSPDisplayList(glist_ptr++, OS_K0_TO_PHYSICAL(perfline_dl));

  /* ディスプレイリストの作成 */
  for(cnt = 0; cnt < vtx_index; cnt +=2){
    /* 頂点キャッシュに頂点をロード */
    if( (cnt % 16 ) == 0){ 
      /* 残りの頂点数の計算 */
      if((vtx_index-cnt) > 16 ){
	vtx_rest = 16;
      }	else {
	/* 残りの頂点数が16以下の場合 */
	vtx_rest = vtx_index-cnt;
      }
      /* 頂点のロード */
      gSPVertex(glist_ptr++, &meter_vtx[cnt], vtx_rest, 0);
    }
    gSPLineW3D(glist_ptr++, cnt, cnt+1, 7,0);

  }
  /* おしまい */
  gDPPipeSync(glist_ptr++);
#endif /* NN_SC_PERF */
}