开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 多媒体 > 视频捕捉/采集 > 查看源码
gsub.c
资源名称：handvu-beta3.tar.gz　[点击查看]
上传用户：lijia5631
上传日期：2008-11-10
资源大小：1214k
文件大小：41k
源码类别：

视频捕捉/采集

开发平台：

MultiPlatform

gsub.c：源码内容
  1. #include <stdio.h>
  2. #include <stdlib.h>
  3. #if defined(_WIN32)
  4. #include <windows.h>
  5. #include <string.h>
  6. #endif
  7. #ifndef __APPLE__
  8. #include <GL/gl.h>
  9. #else
  10. #include <OpenGL/gl.h>
  11. #endif
  12. #include "sdlut.h"
  13. #include <AR/config.h>
  14. #include <AR/param.h>
  15. #include <AR/ar.h>
  16. #include "gsub.h"
  18. #ifndef GL_ABGR
  19. #define GL_ABGR GL_ABGR_EXT
  20. #endif
  21. #ifndef GL_BGRA
  22. #define GL_BGRA GL_BGRA_EXT
  23. #endif
  24. #ifndef GL_BGR
  25. #define GL_BGR GL_BGR_EXT
  26. #endif
  27. #ifndef GL_RGBA
  28. #define GL_RGBA GL_RGBA_EXT
  29. #endif
  30. #ifndef GL_RGB
  31. #define GL_RGB GL_RGB_EXT
  32. #endif
  34. #define   MINIWIN_MAX    8
  35. #define   REVERSE_LR     1
  36. #define   LEFTEYE        1
  37. #define   RIGHTEYE       2
  38. #define   GMINI          2
  40. /*int  argDrawMode   = DEFAULT_DRAW_MODE;*/
  41. int  argDrawMode   = AR_DRAW_BY_GL_DRAW_PIXELS;
  42. int  argTexmapMode = DEFAULT_DRAW_TEXTURE_IMAGE;
  45. static ARParam  gCparam;
  46. static double   gl_cpara[16];
  47. static double   gl_lpara[16];
  48. static double   gl_rpara[16];
  49. static int      gl_hmd_flag      = 0;
  50. static int      gl_hmd_para_flag = 0;
  52. static double   gZoom;
  53. static int      gXsize, gYsize;
  54. static int      gMiniXnum,  gMiniYnum;
  55. static int      gMiniXsize, gMiniYsize;
  56. static int      gWinXsize, gWinYsize;
  57. static int      gImXsize, gImYsize;
  58. /*static int      win;*/
  59. static GLuint   glid[3];
  61. static void (*gMouseFunc)(int button, int state, int x, int y);
  62. static void (*gKeyFunc)(unsigned char key, int x, int y);
  63. static void (*gMainFunc)(void);
  66. /* static void argInit2( int fullFlag ); */
  67. static void argInitLoop(void);
  68. static void argInitStencil(void);
  69. static void argSetStencil( int flag );
  70. static void argConvGLcpara2( double cparam[3][4], int width, int height, double gnear, double gfar, double m[16] );
  73. static int    tex1Xsize1 = 1;
  74. static int    tex1Xsize2 = 1;
  75. static int    tex1Ysize  = 1;
  76. static int    tex2Xsize  = 1;
  77. static int    tex2Ysize  = 1;
  78. static void   argDispImageTex3( ARUint8 *image, int xwin, int ywin, int mode );
  79. static void   argDispImageTex4( ARUint8 *image, int xwin, int ywin, int mode );
  80. static void   argDispHalfImageTex( ARUint8 *image, int xwin, int ywin, int mode );
  81. static void   argDispImageDrawPixels( ARUint8 *image, int xwin, int ywin );
  82. static void   argDispHalfImageDrawPixels( ARUint8 *image, int xwin, int ywin );
  84. void argInqSetting( int *hmdMode,
  85.                     int *gMiniXnum2, int *gMiniYnum2,
  86.                     void (**mouseFunc)(int button, int state, int x, int y),
  87.                     void (**keyFunc)(unsigned char key, int x, int y),
  88.                     void (**mainFunc)(void) )
  89. {
  90.     *hmdMode    = gl_hmd_flag;
  91.     *gMiniXnum2 = gMiniXnum;
  92.     *gMiniYnum2 = gMiniYnum;
  93.     *mouseFunc = gMouseFunc;
  94.     *keyFunc   = gKeyFunc;
  95.     *mainFunc  = gMainFunc;
  96. }
  98. void argInit( ARParam *cparam, double zoom, /*int fullFlag,*/ int xwin, int ywin, int hmd_flag )
  99. {
  100.     int       i;
  102. #ifdef __APPLE__
  103.     {
  104.         static int initF = 0;
  105.         int        argc = 1;
  106.         char      *argv[1] = {"ARToolKit for MacOSX"};
  107. /*
  108.         if( initF == 0 ) { glutInit(&argc, argv); initF = 1; }
  109. */
  110.     }
  111. #endif
  113.     gl_hmd_flag = hmd_flag;
  114.     gZoom  = zoom;
  115.     gImXsize = cparam->xsize;
  116.     gImYsize = cparam->ysize;
  117.     if( gl_hmd_flag == 0 ) {
  118.         gXsize = (double)cparam->xsize * gZoom;
  119.         gYsize = (double)cparam->ysize * gZoom;
  120.     }
  121.     else {
  122.         gXsize = AR_HMD_XSIZE;
  123.         gYsize = AR_HMD_YSIZE;
  124.     }
  125.     gMiniXsize = (double)cparam->xsize * gZoom / GMINI;
  126.     gMiniYsize = (double)cparam->ysize * gZoom / GMINI;
  128.     if( xwin * ywin > MINIWIN_MAX ) {
  129.         if( xwin > MINIWIN_MAX ) xwin = MINIWIN_MAX;
  130.         ywin = MINIWIN_MAX / xwin;
  131.     }
  132.     gMiniXnum = xwin;
  133.     gMiniYnum = ywin;
  134.     gWinXsize = (gMiniXsize*gMiniXnum > gXsize)?
  135.                      gMiniXsize*gMiniXnum: gXsize;
  136.     gWinYsize = gYsize + gMiniYsize*gMiniYnum;
  138.     gCparam = *cparam;
  139.     for( i = 0; i < 4; i++ ) {
  140.         gCparam.mat[1][i] = (gCparam.ysize-1)*(gCparam.mat[2][i]) - gCparam.mat[1][i];
  141.     }
  142.     argConvGLcpara( &gCparam, AR_GL_CLIP_NEAR, AR_GL_CLIP_FAR, gl_cpara );
  144. /*    argInit2( fullFlag ); */
  145. }
  147. void argInitContext( int fullFlag, int fsaaFlag )
  148. {
  149. /*
  150.     glutInitDisplayMode(GLUT_DOUBLE | GLUT_RGBA | GLUT_DEPTH | GLUT_STENCIL);
  151.     glutInitWindowPosition(0, 0);
  152.     glutInitWindowSize(gWinXsize, gWinYsize);
  153.     win = glutCreateWindow("");
  154.     if( fullFlag ) {
  155.         glutFullScreen();
  156.         gWinXsize = glutGet(GLUT_SCREEN_WIDTH);
  157.         gWinYsize = glutGet(GLUT_SCREEN_HEIGHT);
  158.     }
  159. */
  160.     sdlutInit();
  162.     if( fsaaFlag )
  163.       sdlutInitDisplayMode(SDLUT_DOUBLE | SDLUT_RGB | 
  164.                            SDLUT_DEPTH | SDLUT_STENCIL | SDLUT_FSAA);
  165.     else
  166.       sdlutInitDisplayMode(SDLUT_DOUBLE | SDLUT_RGB | 
  167.                            SDLUT_DEPTH | SDLUT_STENCIL);
  168.     if( fullFlag ) {
  169.       sdlutCreateWindow("", gWinXsize, gWinYsize, 24, SDLUT_FULLSCREEN);
  170.     } 
  171.     else {
  172.       sdlutCreateWindow("", gWinXsize, gWinYsize, 24, 0);
  173.     }
  176.     gMouseFunc = NULL;
  177.     gKeyFunc   = NULL;
  178.     gMainFunc  = NULL;
  181.     glGenTextures(3, glid);
  182.     glBindTexture( GL_TEXTURE_2D, glid[0] );
  183.     glPixelStorei( GL_UNPACK_ALIGNMENT, 1 );
  184.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_WRAP_S, GL_CLAMP );
  185.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_WRAP_T, GL_CLAMP );
  186.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_MAG_FILTER, GL_NEAREST );
  187.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_MIN_FILTER, GL_NEAREST );
  188.     glTexEnvf( GL_TEXTURE_ENV, GL_TEXTURE_ENV_MODE, GL_DECAL );
  189.     glBindTexture( GL_TEXTURE_2D, glid[1] );
  190.     glPixelStorei( GL_UNPACK_ALIGNMENT, 1 );
  191.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_WRAP_S, GL_CLAMP );
  192.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_WRAP_T, GL_CLAMP );
  193.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_MAG_FILTER, GL_NEAREST );
  194.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_MIN_FILTER, GL_NEAREST );
  195.     glTexEnvf( GL_TEXTURE_ENV, GL_TEXTURE_ENV_MODE, GL_DECAL );
  196.     glBindTexture( GL_TEXTURE_2D, glid[2] );
  197.     glPixelStorei( GL_UNPACK_ALIGNMENT, 1 );
  198.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_WRAP_S, GL_CLAMP );
  199.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_WRAP_T, GL_CLAMP );
  200.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_MAG_FILTER, GL_NEAREST );
  201.     glTexParameterf( GL_TEXTURE_2D, GL_TEXTURE_MIN_FILTER, GL_NEAREST );
  202.     glTexEnvf( GL_TEXTURE_ENV, GL_TEXTURE_ENV_MODE, GL_DECAL );
  204.     if( gImXsize > 512 ) {
  205.         tex1Xsize1 = 512;
  206.         tex1Xsize2 = 1;
  207.         while( tex1Xsize2 < gImXsize - tex1Xsize1 ) tex1Xsize2 *= 2;
  208.     }
  209.     else {
  210.         tex1Xsize1 = 1;
  211.         while( tex1Xsize1 < gImXsize ) tex1Xsize1 *= 2;
  212.     }
  213.     tex1Ysize  = 1;
  214.     while( tex1Ysize < gImYsize ) tex1Ysize *= 2;
  216.     tex2Xsize = 1;
  217.     while( tex2Xsize < gImXsize/2 ) tex2Xsize *= 2;
  218.     tex2Ysize = 1;
  219.     while( tex2Ysize < gImYsize/2 ) tex2Ysize *= 2;
  220. }
  222. void argCleanup( void )
  223. {
  224. /*
  225.     glutDestroyWindow( win );
  226. */
  227.     sdlutDestroyWindow();
  228. }
  230. void argSwapBuffers( void )
  231. {
  232. /*
  233.     glutSwapBuffers();
  234. */
  235.     sdlutSwapBuffers();
  236. }
  238. void argMainLoop( void (*mouseFunc)(int button, int state, int x, int y),
  239.                   void (*keyFunc)(unsigned char key, int x, int y),
  240.                   void (*mainFunc)(void) )
  241. {
  242.     gMouseFunc = mouseFunc;
  243.     gKeyFunc   = keyFunc;
  244.     gMainFunc  = mainFunc;
  246. /*
  247.     glutDisplayFunc( argInitLoop );
  248.     glutMainLoop();
  249. */
  250.     sdlutDisplayFunc( argInitLoop );
  251.     sdlutMainLoop();
  252. }
  254. static void argInitLoop(void)
  255. {
  256.     arUtilSleep( 500 );
  258.     argDrawMode2D();
  259.     if( gl_hmd_flag ) {
  260.         glClearColor( 0.0, 0.0, 0.0, 0.0 );
  261.         glClear(GL_COLOR_BUFFER_BIT);
  262.         argInitStencil();
  263.         argSwapBuffers();
  264.     }
  266.     glClearColor( 0.0, 0.0, 0.0, 0.0 );
  267.     glClear(GL_COLOR_BUFFER_BIT);
  268.     argSwapBuffers();
  269.     glClear(GL_COLOR_BUFFER_BIT);
  270.     argSwapBuffers();
  272. /*
  273.     glutKeyboardFunc( gKeyFunc );
  274.     glutMouseFunc( gMouseFunc );
  275.     glutDisplayFunc( gMainFunc );
  276.     glutIdleFunc( gMainFunc );
  277. */
  278.     sdlutGlutKeyboardFunc( gKeyFunc );
  279.     sdlutGlutMouseFunc( gMouseFunc );
  280.     sdlutDisplayFunc( gMainFunc );
  281.     sdlutIdleFunc( gMainFunc );
  282. }
  284. void argDrawMode2D( void )
  285. {
  286.     glMatrixMode(GL_MODELVIEW);
  287.     glLoadIdentity();
  288.     glMatrixMode(GL_PROJECTION);
  289.     glLoadIdentity();
  290.     glOrtho(-0.5, gWinXsize-0.5, -0.5, gWinYsize-0.5, -1.0, 1.0);
  291.     glViewport(0, 0, gWinXsize, gWinYsize);
  293.     argSetStencil( 0 );
  294. }
  296. void argDraw2dLeft( void )
  297. {
  298.     if( gl_hmd_flag == 0 ) return;
  300.     argSetStencil( LEFTEYE );
  301. }
  303. void argDraw2dRight( void )
  304. {
  305.     if( gl_hmd_flag == 0 ) return;
  307.     argSetStencil( RIGHTEYE );
  308. }
  310. void argDrawMode3D( void )
  311. {
  312.     glMatrixMode(GL_MODELVIEW);
  313.     glLoadIdentity();
  314.     glScalef( 1, -1, -1 );
  315. }
  317. void argDraw3dLeft( void )
  318. {
  319.     if( gl_hmd_flag == 0 || gl_hmd_para_flag == 0 ) return;
  321.     glViewport(0, gWinYsize-AR_HMD_YSIZE, AR_HMD_XSIZE, AR_HMD_YSIZE);
  322.     argSetStencil( LEFTEYE );
  323.     glMatrixMode(GL_PROJECTION);
  324.     glLoadMatrixd( gl_lpara );
  325. }
  327. void argDraw3dRight( void )
  328. {
  329.     if( gl_hmd_flag == 0 || gl_hmd_para_flag == 0 ) return;
  331.     glViewport(0, gWinYsize-AR_HMD_YSIZE, AR_HMD_XSIZE, AR_HMD_YSIZE);
  332.     argSetStencil( RIGHTEYE );
  333.     glMatrixMode(GL_PROJECTION);
  334.     glLoadMatrixd( gl_rpara );
  335. }
  338. void argDraw3dCamera( int xwin, int ywin )
  339. {
  340.     if( xwin == 0 && ywin == 0 ) {
  341.         glViewport(0, gWinYsize-(int)(gZoom*gImYsize),
  342.                    (int)(gZoom*gImXsize), (int)(gZoom*gImYsize));
  343.     }
  344.     else {
  345.         glViewport((xwin-1)*gMiniXsize, gWinYsize-gYsize-ywin*gMiniYsize,
  346. gMiniXsize, gMiniYsize);
  347.     }
  349.     argSetStencil( 0 );
  350.     
  351.     glMatrixMode(GL_PROJECTION);
  352.     glLoadMatrixd( gl_cpara );
  353.     glScalef( 1, -1, -1 );
  354. }
  357. void argMult3dCamera( int xwin, int ywin )
  358. {
  359.     if( xwin == 0 && ywin == 0 ) {
  360.         glViewport(0, gWinYsize-(int)(gZoom*gImYsize),
  361.                    (int)(gZoom*gImXsize), (int)(gZoom*gImYsize));
  362.     }
  363.     else {
  364.         glViewport((xwin-1)*gMiniXsize, gWinYsize-gYsize-ywin*gMiniYsize,
  365. gMiniXsize, gMiniYsize);
  366.     }
  368.     argSetStencil( 0 );
  369.     
  370.     glMatrixMode(GL_PROJECTION);
  371.     glMultMatrixd( gl_cpara );
  372.     glScalef( 1, -1, -1 );
  373. }
  376. void argConvGlparad( double para[3][4], double gl_para[16] )
  377. {
  378.     int     i, j;
  380.     for( j = 0; j < 3; j++ ) {
  381.         for( i = 0; i < 4; i++ ) {
  382.             gl_para[i*4+j] = para[j][i];
  383.         }
  384.     }
  385.     gl_para[0*4+3] = gl_para[1*4+3] = gl_para[2*4+3] = 0.0;
  386.     gl_para[3*4+3] = 1.0;
  387. }
  390. void argConvGlparaf( double para[3][4], float gl_para[16] )
  391. {
  392.     int     i, j;
  394.     for( j = 0; j < 3; j++ ) {
  395.         for( i = 0; i < 4; i++ ) {
  396.             gl_para[i*4+j] = para[j][i];
  397.         }
  398.     }
  399.     gl_para[0*4+3] = gl_para[1*4+3] = gl_para[2*4+3] = 0.0;
  400.     gl_para[3*4+3] = 1.0;
  401. }
  404. void argDispImage( ARUint8 *image, int xwin, int ywin )
  405. {
  406.     if( argDrawMode == AR_DRAW_BY_GL_DRAW_PIXELS ) {
  407.         argDispImageDrawPixels( image, xwin, ywin );
  408.     }
  409.     else {
  410.         if( xwin == 0 && ywin == 0 ) {
  411.             glScissor(0, gWinYsize-(int)(gZoom*gImYsize),
  412.                       (int)(gZoom*gImXsize), (int)(gZoom*gImYsize));
  413.         }
  414.         else {
  415.             glScissor((xwin-1)*gMiniXsize, gWinYsize-gYsize-ywin*gMiniYsize,
  416.                        gMiniXsize, gMiniYsize);
  417.         }
  418.         glEnable( GL_SCISSOR_TEST );
  419.         /* glDisable( GL_DEPTH_TEST ); */
  420.         if( gImXsize > tex1Xsize1 )
  421.             argDispImageTex3( image, xwin, ywin, 0 );
  422.         else
  423.             argDispImageTex4( image, xwin, ywin, 0 );
  424.         glDisable( GL_SCISSOR_TEST );
  425.     }
  426. }
  428. static void argDispImageDrawPixels( ARUint8 *image, int xwin, int ywin )
  429. {
  430.     int      sx, sy;
  431.     GLfloat  zoom;
  433.     if( xwin == 0 && ywin == 0 ) {
  434. zoom = gZoom;
  435.         sx = 0;
  436.         sy = gWinYsize - 1;
  437.     }
  438.     else if( xwin == 1 && ywin == 0 ) {
  439. zoom = gZoom;
  440.         sx = gXsize;
  441.         sy = gWinYsize - 1;
  442.     }
  443.     else {
  444.         zoom = gZoom / (double)GMINI;
  445.         sx = (xwin-1)*gMiniXsize;
  446.         sy = gWinYsize - gYsize - (ywin-1)*gMiniYsize - 1;
  447.     }
  448.     glPixelZoom( zoom, -zoom);
  449.     /* glRasterPos3i( sx, sy, 0 ); */
  450.     glRasterPos3i( sx, sy, -1 );
  452. #ifdef  AR_PIX_FORMAT_ABGR
  453.     glDrawPixels( gImXsize, gImYsize, GL_ABGR, GL_UNSIGNED_BYTE, image );
  454. #endif
  455. #ifdef  AR_PIX_FORMAT_BGRA
  456.     glDrawPixels( gImXsize, gImYsize, GL_BGRA, GL_UNSIGNED_BYTE, image );
  457. #endif
  458. #ifdef  AR_PIX_FORMAT_BGR
  459.     glDrawPixels( gImXsize, gImYsize, GL_BGR, GL_UNSIGNED_BYTE, image );
  460. #endif
  461. #ifdef  AR_PIX_FORMAT_RGBA
  462.     glDrawPixels( gImXsize, gImYsize, GL_RGBA, GL_UNSIGNED_BYTE, image );
  463. #endif
  464. #ifdef  AR_PIX_FORMAT_RGB
  465.     glDrawPixels( gImXsize, gImYsize, GL_RGB, GL_UNSIGNED_BYTE, image );
  466. #endif
  467. }
  469. #ifndef _WIN32
  470. static void argDispImageTex4( ARUint8 *image, int xwin, int ywin, int mode )
  471. #else
  472. static void argDispImageTex4( ARUint8 *wimage, int xwin, int ywin, int mode )
  473. #endif
  474. {
  475.     static int      initf = 1;
  476.     static int      flag[3][MINIWIN_MAX+2][2];
  477.     static int      listIndex[3][MINIWIN_MAX+2][2];
  478. #ifdef _WIN32
  479.     static ARUint8  *image = NULL;
  480. #endif
  481.     double   *dist_factor = NULL;
  482.     double   tsx, tsy, tex, tey;
  483.     double   px, py, qx, qy, z;
  484.     double   x1, x2, x3, x4;
  485.     double   y1, y2, y3, y4;
  486.     double   xx1, xx2, xx3, xx4;
  487.     double   yy1, yy2, yy3, yy4;
  488.     int      size_adjust_factor;
  489.     int      list, win;
  490.     int      i, j;
  492.     switch( mode ) {
  493.       case 0: dist_factor = &(gCparam.dist_factor[0]);   break;
  494.     }
  496. #ifdef _WIN32
  497.     if( image == NULL ) {
  498.         arMalloc(image,ARUint8,gImXsize*tex1Ysize*AR_PIX_SIZE);
  499.     }
  500.     memcpy(image, wimage, gImXsize*gImYsize*AR_PIX_SIZE);
  501. #endif
  503.     if( initf ) {
  504.         for(j=0;j<3;j++) {
  505.             for(i=0;i<MINIWIN_MAX+2;i++) flag[j][i][0] = flag[j][i][1] = 1;
  506.         }
  507.         initf = 0;
  508.     }
  509.     if( argTexmapMode == AR_DRAW_TEXTURE_HALF_IMAGE ) {
  510.         size_adjust_factor = 2;
  511.         list = 1;
  512.     }
  513.     else {
  514.         size_adjust_factor = 1;
  515.         list = 0;
  516.     }
  517.     if( xwin == 0 && ywin == 0 )      win = 0;
  518.     else if( xwin == 1 && ywin == 0 ) win = 1;
  519.     else win = gMiniXnum * (ywin-1) + xwin + 1;
  521.     glEnable( GL_TEXTURE_2D );
  522.     glMatrixMode(GL_TEXTURE);
  523.     glLoadIdentity();
  524.     glMatrixMode(GL_MODELVIEW);
  526.     glPixelStorei( GL_UNPACK_ROW_LENGTH, gImXsize*size_adjust_factor );
  527. #ifndef _WIN32
  528.     glPixelStorei( GL_UNPACK_IMAGE_HEIGHT, gImYsize/size_adjust_factor );
  529. #endif
  531.     glBindTexture( GL_TEXTURE_2D, glid[0] );
  532. #ifdef  AR_PIX_FORMAT_ABGR
  533.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_ABGR, GL_UNSIGNED_BYTE, image );
  534. #endif
  535. #ifdef  AR_PIX_FORMAT_BGRA
  536.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_BGRA, GL_UNSIGNED_BYTE, image );
  537. #endif
  538. #ifdef  AR_PIX_FORMAT_BGR
  539.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_BGR, GL_UNSIGNED_BYTE, image );
  540. #endif
  541. #ifdef  AR_PIX_FORMAT_RGBA
  542.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_RGBA, GL_UNSIGNED_BYTE, image );
  543. #endif
  544. #ifdef  AR_PIX_FORMAT_RGB
  545.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_RGB, GL_UNSIGNED_BYTE, image );
  546. #endif
  548.     if( flag[mode][win][list] ) {
  549.         listIndex[mode][win][list] = glGenLists(1);
  550.         glNewList(listIndex[mode][win][list], GL_COMPILE_AND_EXECUTE);
  552.         z = -1.0;
  553.         qy = gImYsize   * 0 / 20.0;
  554.         tey = ((double)gImYsize / (double)tex1Ysize) * (double)0 / 20.0;
  555.         for( j = 1; j <= 20; j++ ) {
  556.             py = qy;
  557.             tsy = tey;
  558.             qy = gImYsize   * j / 20.0;
  559.             tey = ((double)gImYsize / (double)tex1Ysize) * (double)j / 20.0;
  561.             qx = gImXsize * 0 / 20.0;
  562.             tex = ((double)gImXsize / (double)(tex1Xsize1)) * (double)0 / 20.0;
  563.             for( i = 1; i <= 20; i++ ) {
  564.                 px = qx;
  565.                 tsx = tex;
  566.                 qx = gImXsize * i / 20.0;
  567.                 tex = ((double)gImXsize / (double)(tex1Xsize1)) * (double)i / 20.0;
  569.                 arParamObserv2Ideal( dist_factor, px, py, &x1, &y1 );
  570.                 arParamObserv2Ideal( dist_factor, qx, py, &x2, &y2 );
  571.                 arParamObserv2Ideal( dist_factor, qx, qy, &x3, &y3 );
  572.                 arParamObserv2Ideal( dist_factor, px, qy, &x4, &y4 );
  574.                 if( xwin == 0 && ywin == 0 ) {
  575.                     xx1 = x1 * gZoom - 1.0;
  576.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  577.                     xx2 = x2 * gZoom - 1.0;
  578.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  579.                     xx3 = x3 * gZoom - 1.0;
  580.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  581.                     xx4 = x4 * gZoom - 1.0;
  582.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  583.                 }
  584.                 else if( xwin == 1 && ywin == 0 ) {
  585.                     xx1 = gXsize + x1 * gZoom - 1.0;
  586.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  587.                     xx2 = gXsize + x2 * gZoom - 1.0;
  588.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  589.                     xx3 = gXsize + x3 * gZoom - 1.0;
  590.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  591.                     xx4 = gXsize + x4 * gZoom - 1.0;
  592.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  593.                 }
  594.                 else {
  595.                     xx1 = (xwin-1)*gMiniXsize + x1*gZoom/(double)GMINI - 1.0;
  596.                     xx2 = (xwin-1)*gMiniXsize + x2*gZoom/(double)GMINI - 1.0;
  597.                     xx3 = (xwin-1)*gMiniXsize + x3*gZoom/(double)GMINI - 1.0;
  598.                     xx4 = (xwin-1)*gMiniXsize + x4*gZoom/(double)GMINI - 1.0;
  599.                     yy1 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y1*gZoom/(double)GMINI - 1.0;
  600.                     yy2 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y2*gZoom/(double)GMINI - 1.0;
  601.                     yy3 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y3*gZoom/(double)GMINI - 1.0;
  602.                     yy4 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y4*gZoom/(double)GMINI - 1.0;
  603.                 }
  605.                 glBegin( GL_QUADS );
  606.                 glTexCoord2d( tsx, tsy ); glVertex3d( xx1, yy1, z );
  607.                 glTexCoord2d( tex, tsy ); glVertex3d( xx2, yy2, z );
  608.                 glTexCoord2d( tex, tey ); glVertex3d( xx3, yy3, z );
  609.                 glTexCoord2d( tsx, tey ); glVertex3d( xx4, yy4, z );
  610.                 glEnd();
  611.             }
  612.         }
  613.         glEndList();
  614.         flag[mode][win][list] = 0;
  615.     }
  616.     else {
  617.         glCallList( listIndex[mode][win][list] );
  618.     }
  620.     glBindTexture( GL_TEXTURE_2D, 0 );
  621.     glDisable( GL_TEXTURE_2D );
  622.     glPixelStorei( GL_UNPACK_ROW_LENGTH, 0 );
  623. #ifndef _WIN32
  624.     glPixelStorei( GL_UNPACK_IMAGE_HEIGHT, 0 );
  625. #endif
  626. }
  628. #ifndef _WIN32
  629. static void argDispImageTex3( ARUint8 *image, int xwin, int ywin, int mode )
  630. #else
  631. static void argDispImageTex3( ARUint8 *wimage, int xwin, int ywin, int mode )
  632. #endif
  633. {
  634.     static int      initf = 1;
  635.     static int      flag[3][MINIWIN_MAX+2][2];
  636.     static int      listIndex[3][MINIWIN_MAX+2][2];
  637. #ifdef _WIN32
  638.     static ARUint8  *image = NULL;
  639. #endif
  640.     double   *dist_factor = NULL;
  641.     double   tsx, tsy, tex, tey;
  642.     double   px, py, qx, qy, z;
  643.     double   x1, x2, x3, x4;
  644.     double   y1, y2, y3, y4;
  645.     double   xx1, xx2, xx3, xx4;
  646.     double   yy1, yy2, yy3, yy4;
  647.     int      size_adjust_factor;
  648.     int      win, list;
  649.     int      i, j;
  651.     switch( mode ) {
  652.       case 0: dist_factor = &(gCparam.dist_factor[0]);   break;
  653.     }
  655. #ifdef _WIN32
  656.     if( image == NULL ) {
  657.         arMalloc(image,ARUint8,gImXsize*tex1Ysize*AR_PIX_SIZE);
  658.     }
  659.     memcpy(image, wimage, gImXsize*gImYsize*AR_PIX_SIZE);
  660. #endif
  662.     if( initf ) {
  663.         for(j=0;j<3;j++) {
  664.             for(i=0;i<=MINIWIN_MAX;i++) flag[j][i][0] = flag[j][i][1] = 1;
  665.         }
  666.         initf = 0;
  667.     }
  668.     if( argTexmapMode == AR_DRAW_TEXTURE_HALF_IMAGE ) {
  669.         size_adjust_factor = 2;
  670.         list = 1;
  671.     }
  672.     else {
  673.         size_adjust_factor = 1;
  674.         list = 0;
  675.     }
  676.     if( xwin == 0 && ywin == 0 )      win = 0;
  677.     else if( xwin == 1 && ywin == 0 ) win = 1;
  678.     else win = gMiniXnum * (ywin-1) + xwin + 1;
  680.     glEnable( GL_TEXTURE_2D );
  681.     glMatrixMode(GL_TEXTURE);
  682.     glLoadIdentity();
  683.     glMatrixMode(GL_MODELVIEW);
  685.     glPixelStorei( GL_UNPACK_ROW_LENGTH, gImXsize*size_adjust_factor );
  686. #ifndef _WIN32
  687.     glPixelStorei( GL_UNPACK_IMAGE_HEIGHT, gImYsize/size_adjust_factor );
  688. #endif
  690.     glBindTexture( GL_TEXTURE_2D, glid[0] );
  691. #ifdef  AR_PIX_FORMAT_ABGR
  692.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_ABGR, GL_UNSIGNED_BYTE, image );
  693. #endif
  694. #ifdef  AR_PIX_FORMAT_BGRA
  695.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_BGRA, GL_UNSIGNED_BYTE, image );
  696. #endif
  697. #ifdef  AR_PIX_FORMAT_BGR
  698.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_BGR, GL_UNSIGNED_BYTE, image );
  699. #endif
  700. #ifdef  AR_PIX_FORMAT_RGBA
  701.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_RGBA, GL_UNSIGNED_BYTE, image );
  702. #endif
  703. #ifdef  AR_PIX_FORMAT_RGB
  704.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize1, tex1Ysize/size_adjust_factor, 0, GL_RGB, GL_UNSIGNED_BYTE, image );
  705. #endif
  707.     if( flag[mode][win][list] ) {
  708.         listIndex[mode][win][list] = glGenLists(2);
  709.         glNewList(listIndex[mode][win][list], GL_COMPILE_AND_EXECUTE);
  711.         z = -1.0;
  712.         qy = gImYsize   * 0 / 20.0;
  713.         tey = ((double)gImYsize / (double)tex1Ysize) * (double)0 / 20.0;
  714.         for( j = 1; j <= 20; j++ ) {
  715.             py = qy;
  716.             tsy = tey;
  717.             qy = gImYsize   * j / 20.0;
  718.             tey = ((double)gImYsize / (double)tex1Ysize) * (double)j / 20.0;
  720.             qx = tex1Xsize1 * 0 / 16.0;
  721.             tex = (double)0 / 16.0;
  722.             for( i = 1; i <= 16; i++ ) {
  723.                 px = qx;
  724.                 tsx = tex;
  725.                 qx = tex1Xsize1 * i / 16.0;
  726.                 tex = (double)i / 16.0;
  728.                 arParamObserv2Ideal( dist_factor, px, py, &x1, &y1 );
  729.                 arParamObserv2Ideal( dist_factor, qx, py, &x2, &y2 );
  730.                 arParamObserv2Ideal( dist_factor, qx, qy, &x3, &y3 );
  731.                 arParamObserv2Ideal( dist_factor, px, qy, &x4, &y4 );
  733.                 if( x2 < x1 ) continue;
  734.                 if( x4 > x3 ) continue;
  735.                 if( y4 < y1 ) continue;
  736.                 if( y3 < y2 ) continue;
  737.                 if( x2 < 0 || x3 < 0 ) continue;
  738.                 if( x1 > gImXsize || x4 > gImXsize ) continue;
  739.                 if( y4 < 0 || y3 < 0 ) continue;
  740.                 if( y1 > gImYsize || y2 > gImXsize ) continue;
  742.                 if( xwin == 0 && ywin == 0 ) {
  743.                     xx1 = x1 * gZoom - 1.0;
  744.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  745.                     xx2 = x2 * gZoom - 1.0;
  746.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  747.                     xx3 = x3 * gZoom - 1.0;
  748.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  749.                     xx4 = x4 * gZoom - 1.0;
  750.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  751.                 }
  752.                 else if( xwin == 1 && ywin == 0 ) {
  753.                     xx1 = gXsize + x1 * gZoom - 1.0;
  754.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  755.                     xx2 = gXsize + x2 * gZoom - 1.0;
  756.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  757.                     xx3 = gXsize + x3 * gZoom - 1.0;
  758.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  759.                     xx4 = gXsize + x4 * gZoom - 1.0;
  760.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  761.                 }
  762.                 else {
  763.                     xx1 = (xwin-1)*gMiniXsize + x1*gZoom/(double)GMINI - 1.0;
  764.                     xx2 = (xwin-1)*gMiniXsize + x2*gZoom/(double)GMINI - 1.0;
  765.                     xx3 = (xwin-1)*gMiniXsize + x3*gZoom/(double)GMINI - 1.0;
  766.                     xx4 = (xwin-1)*gMiniXsize + x4*gZoom/(double)GMINI - 1.0;
  767.                     yy1 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y1*gZoom/(double)GMINI - 1.0;
  768.                     yy2 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y2*gZoom/(double)GMINI - 1.0;
  769.                     yy3 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y3*gZoom/(double)GMINI - 1.0;
  770.                     yy4 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y4*gZoom/(double)GMINI - 1.0;
  771.                 }
  773.                 glBegin( GL_QUADS );
  774.                 glTexCoord2d( tsx, tsy ); glVertex3d( xx1, yy1, z );
  775.                 glTexCoord2d( tex, tsy ); glVertex3d( xx2, yy2, z );
  776.                 glTexCoord2d( tex, tey ); glVertex3d( xx3, yy3, z );
  777.                 glTexCoord2d( tsx, tey ); glVertex3d( xx4, yy4, z );
  778.                 glEnd();
  779.             }
  780.         }
  781.         glEndList();
  782.     }
  783.     else {
  784.         glCallList( listIndex[mode][win][list] );
  785.     }
  787.     glBindTexture( GL_TEXTURE_2D, glid[1] );
  788. #ifdef  AR_PIX_FORMAT_ABGR
  789.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize2, tex1Ysize/size_adjust_factor, 0, GL_ABGR, GL_UNSIGNED_BYTE, image+tex1Xsize1*AR_PIX_SIZE );
  790. #endif
  791. #ifdef  AR_PIX_FORMAT_BGRA
  792.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize2, tex1Ysize/size_adjust_factor, 0, GL_BGRA, GL_UNSIGNED_BYTE, image+tex1Xsize1*AR_PIX_SIZE );
  793. #endif
  794. #ifdef  AR_PIX_FORMAT_BGR
  795.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize2, tex1Ysize/size_adjust_factor, 0, GL_BGR, GL_UNSIGNED_BYTE, image+tex1Xsize1*AR_PIX_SIZE );
  796. #endif
  797. #ifdef  AR_PIX_FORMAT_RGBA
  798.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize2, tex1Ysize/size_adjust_factor, 0, GL_RGBA, GL_UNSIGNED_BYTE, image+tex1Xsize1*AR_PIX_SIZE );
  799. #endif
  800. #ifdef  AR_PIX_FORMAT_RGB
  801.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex1Xsize2, tex1Ysize/size_adjust_factor, 0, GL_RGB, GL_UNSIGNED_BYTE, image+tex1Xsize1*AR_PIX_SIZE );
  802. #endif
  804.     if( flag[mode][win][list] ) {
  805.         glNewList(listIndex[mode][win][list]+1, GL_COMPILE_AND_EXECUTE);
  807.         z = -1.0;
  808.         qy = gImYsize   * 0 / 20.0;
  809.         tey = ((double)gImYsize / (double)tex1Ysize) * (double)0 / 20.0;
  810.         for( j = 1; j <= 20; j++ ) {
  811.             py = qy;
  812.             tsy = tey;
  813.             qy = gImYsize   * j / 20.0;
  814.             tey = ((double)gImYsize / (double)tex1Ysize) * (double)j / 20.0;
  816.             qx = tex1Xsize1 + (gImXsize-tex1Xsize1) * 0 / 4.0;
  817.             tex = ((double)(gImXsize-tex1Xsize1) / (double)tex1Xsize2) * 0 / 4.0;
  818.             for( i = 1; i <= 4; i++ ) {
  819.                 px = qx;
  820.                 tsx = tex;
  821.                 qx = tex1Xsize1 + (gImXsize-tex1Xsize1) * i / 4.0;
  822.                 tex = ((double)(gImXsize-tex1Xsize1) / (double)tex1Xsize2) * i / 4.0;
  824.                 arParamObserv2Ideal( dist_factor, px, py, &x1, &y1 );
  825.                 arParamObserv2Ideal( dist_factor, qx, py, &x2, &y2 );
  826.                 arParamObserv2Ideal( dist_factor, qx, qy, &x3, &y3 );
  827.                 arParamObserv2Ideal( dist_factor, px, qy, &x4, &y4 );
  829.                 if( x2 < x1 ) continue;
  830.                 if( x4 > x3 ) continue;
  831.                 if( y4 < y1 ) continue;
  832.                 if( y3 < y2 ) continue;
  833.                 if( x2 < 0 || x3 < 0 ) continue;
  834.                 if( x1 > gImXsize || x4 > gImXsize ) continue;
  835.                 if( y4 < 0 || y3 < 0 ) continue;
  836.                 if( y1 > gImYsize || y2 > gImXsize ) continue;
  838.                 if( xwin == 0 && ywin == 0 ) {
  839.                     xx1 = x1 * gZoom - 1.0;
  840.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  841.                     xx2 = x2 * gZoom - 1.0;
  842.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  843.                     xx3 = x3 * gZoom - 1.0;
  844.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  845.                     xx4 = x4 * gZoom - 1.0;
  846.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  847.                 }
  848.                 else if( xwin == 1 && ywin == 0 ) {
  849.                     xx1 = gXsize + x1 * gZoom - 1.0;
  850.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  851.                     xx2 = gXsize + x2 * gZoom - 1.0;
  852.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  853.                     xx3 = gXsize + x3 * gZoom - 1.0;
  854.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  855.                     xx4 = gXsize + x4 * gZoom - 1.0;
  856.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  857.                 }
  858.                 else {
  859.                     xx1 = (xwin-1)*gMiniXsize + x1*gZoom/(double)GMINI - 1.0;
  860.                     xx2 = (xwin-1)*gMiniXsize + x2*gZoom/(double)GMINI - 1.0;
  861.                     xx3 = (xwin-1)*gMiniXsize + x3*gZoom/(double)GMINI - 1.0;
  862.                     xx4 = (xwin-1)*gMiniXsize + x4*gZoom/(double)GMINI - 1.0;
  863.                     yy1 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y1*gZoom/(double)GMINI - 1.0;
  864.                     yy2 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y2*gZoom/(double)GMINI - 1.0;
  865.                     yy3 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y3*gZoom/(double)GMINI - 1.0;
  866.                     yy4 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y4*gZoom/(double)GMINI - 1.0;
  867.                 }
  869.                 glBegin( GL_QUADS );
  870.                 glTexCoord2d( tsx, tsy ); glVertex3d( xx1, yy1, z );
  871.                 glTexCoord2d( tex, tsy ); glVertex3d( xx2, yy2, z );
  872.                 glTexCoord2d( tex, tey ); glVertex3d( xx3, yy3, z );
  873.                 glTexCoord2d( tsx, tey ); glVertex3d( xx4, yy4, z );
  874.                 glEnd();
  875.             }
  876.         }
  877.         glEndList();
  878.         flag[mode][win][list] = 0;
  879.     }
  880.     else {
  881.         glCallList( listIndex[mode][win][list]+1 );
  882.     }
  884.     glBindTexture( GL_TEXTURE_2D, 0 );
  885.     glDisable( GL_TEXTURE_2D );
  886.     glPixelStorei( GL_UNPACK_ROW_LENGTH, 0 );
  887. #ifndef _WIN32
  888.     glPixelStorei( GL_UNPACK_IMAGE_HEIGHT, 0 );
  889. #endif
  890. }
  892. void argDispHalfImage( ARUint8 *image, int xwin, int ywin )
  893. {
  894.     if( argDrawMode == AR_DRAW_BY_GL_DRAW_PIXELS ) {
  895.         argDispHalfImageDrawPixels( image, xwin, ywin );
  896.     }
  897.     else {
  898.         if( xwin == 0 && ywin == 0 ) {
  899.             glScissor(0, gWinYsize-(int)(gZoom*gImYsize),
  900.                       (int)(gZoom*gImXsize), (int)(gZoom*gImYsize));
  901.         }
  902.         else {
  903.             glScissor((xwin-1)*gMiniXsize, gWinYsize-gYsize-ywin*gMiniYsize,
  904.                        gMiniXsize, gMiniYsize);
  905.         }
  906.         glEnable( GL_SCISSOR_TEST );
  907.         /* glDisable( GL_DEPTH_TEST ); */
  908.         argDispHalfImageTex( image, xwin, ywin, 0 );
  909.         glDisable( GL_SCISSOR_TEST );
  910.     }
  911. }
  913. static void argDispHalfImageDrawPixels( ARUint8 *image, int xwin, int ywin )
  914. {
  915.     int      sx, sy;
  916.     GLfloat  zoom;
  918.     if( xwin == 0 && ywin == 0 ) {
  919. zoom = gZoom * 2.0;
  920.         sx = 0;
  921.         sy = gWinYsize - 1;
  922.     }
  923.     if( xwin == 1 && ywin == 0 ) {
  924. zoom = gZoom * 2.0;
  925.         sx = gXsize;
  926.         sy = gWinYsize - 1;
  927.     }
  928.     else {
  929.         zoom = gZoom / (double)GMINI * 2.0;
  930.         sx = (xwin-1)*gMiniXsize;
  931.         sy = gWinYsize - gYsize - (ywin-1)*gMiniYsize - 1;
  932.     }
  933.     glPixelZoom( zoom, -zoom);
  934.     /* glRasterPos3i( sx, sy, 0 ); */
  935.     glRasterPos3i( sx, sy, -1 );
  937. #ifdef  AR_PIX_FORMAT_ABGR
  938.     glDrawPixels( gImXsize/2, gImYsize/2, GL_ABGR, GL_UNSIGNED_BYTE, image );
  939. #endif
  940. #ifdef  AR_PIX_FORMAT_BGRA
  941.     glDrawPixels( gImXsize/2, gImYsize/2, GL_BGRA, GL_UNSIGNED_BYTE, image );
  942. #endif
  943. #ifdef  AR_PIX_FORMAT_BGR
  944.     glDrawPixels( gImXsize/2, gImYsize/2, GL_BGR, GL_UNSIGNED_BYTE, image );
  945. #endif
  946. #ifdef  AR_PIX_FORMAT_RGBA
  947.     glDrawPixels( gImXsize/2, gImYsize/2, GL_RGBA, GL_UNSIGNED_BYTE, image );
  948. #endif
  949. #ifdef  AR_PIX_FORMAT_RGB
  950.     glDrawPixels( gImXsize/2, gImYsize/2, GL_RGB, GL_UNSIGNED_BYTE, image );
  951. #endif
  952. }
  954. #ifndef _WIN32
  955. static void argDispHalfImageTex( ARUint8 *image, int xwin, int ywin, int mode )
  956. #else
  957. static void argDispHalfImageTex( ARUint8 *wimage, int xwin, int ywin, int mode )
  958. #endif
  959. {
  960.     static int      initf = 1;
  961.     static int      flag[3][MINIWIN_MAX+2];
  962.     static int      listIndex[3][MINIWIN_MAX+2];
  963. #ifdef _WIN32
  964.     static ARUint8  *image = NULL;
  965. #endif
  966.     double   *dist_factor = NULL;
  967.     double   tsx, tsy, tex, tey;
  968.     double   px, py, qx, qy, z;
  969.     double   x1, x2, x3, x4;
  970.     double   y1, y2, y3, y4;
  971.     double   xx1, xx2, xx3, xx4;
  972.     double   yy1, yy2, yy3, yy4;
  973.     int      win;
  974.     int      i, j;
  976.     switch( mode ) {
  977.       case 0: dist_factor = &(gCparam.dist_factor[0]);   break;
  978.     }
  980. #ifdef _WIN32
  981.     if( image == NULL ) {
  982. arMalloc(image,ARUint8,tex2Xsize*tex2Ysize*AR_PIX_SIZE);
  983.     }
  984. memcpy(image, wimage, gImXsize*gImYsize*AR_PIX_SIZE/4);
  985. #endif
  987.     if( initf ) {
  988.         for(j=0;j<3;j++) {
  989.             for(i=0;i<=MINIWIN_MAX;i++) flag[j][i] = 1;
  990.         }
  991.         initf = 0;
  992.     }
  993.     if( xwin == 0 && ywin == 0 )      win = 0;
  994.     else if( xwin == 1 && ywin == 0 ) win = 1;
  995.     else win = gMiniXnum * (ywin-1) + xwin + 1;
  997.     glEnable( GL_TEXTURE_2D );
  998.     glMatrixMode(GL_TEXTURE);
  999.     glLoadIdentity();
  1000.     glMatrixMode(GL_MODELVIEW);
  1002.     glPixelStorei( GL_UNPACK_ROW_LENGTH, gImXsize/2 );
  1003. #ifndef _WIN32
  1004.     glPixelStorei( GL_UNPACK_IMAGE_HEIGHT, gImYsize/2 );
  1005. #endif
  1007.     glBindTexture( GL_TEXTURE_2D, glid[2] );
  1008. #ifdef  AR_PIX_FORMAT_ABGR
  1009.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex2Xsize, tex2Ysize, 0, GL_ABGR, GL_UNSIGNED_BYTE, image );
  1010. #endif
  1011. #ifdef  AR_PIX_FORMAT_BGRA
  1012.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex2Xsize, tex2Ysize, 0, GL_BGRA, GL_UNSIGNED_BYTE, image );
  1013. #endif
  1014. #ifdef  AR_PIX_FORMAT_BGR
  1015.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex2Xsize, tex2Ysize, 0, GL_BGR, GL_UNSIGNED_BYTE, image );
  1016. #endif
  1017. #ifdef  AR_PIX_FORMAT_RGBA
  1018.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex2Xsize, tex2Ysize, 0, GL_RGBA, GL_UNSIGNED_BYTE, image );
  1019. #endif
  1020. #ifdef  AR_PIX_FORMAT_RGB
  1021.     glTexImage2D( GL_TEXTURE_2D, 0, 3, tex2Xsize, tex2Ysize, 0, GL_RGB, GL_UNSIGNED_BYTE, image );
  1022. #endif
  1024.     if( flag[mode][win] ) {
  1025.         listIndex[mode][win] = glGenLists(1);
  1026.         glNewList(listIndex[mode][win], GL_COMPILE_AND_EXECUTE);
  1028.         z = -1.0;
  1029.         qy = gImYsize * 0 / 20.0;
  1030.         tey = ((double)gImYsize / (double)(tex2Ysize*2.0)) * (double)0 / 20.0;
  1031.         for( j = 1; j <= 20; j++ ) {
  1032.             py = qy;
  1033.             tsy = tey;
  1034.             qy = gImYsize * j / 20.0;
  1035.             tey = ((double)gImYsize / (double)(tex2Ysize*2.0)) * (double)j / 20.0;
  1037.             qx = gImXsize * 0 / 20.0;
  1038.             tex = ((double)gImXsize / (double)(tex2Xsize*2.0)) * (double)0 / 20.0;
  1039.             for( i = 1; i <= 20; i++ ) {
  1040.                 px = qx;
  1041.                 tsx = tex;
  1042.                 qx = gImXsize * i / 20.0;
  1043.                 tex = ((double)gImXsize / (double)(tex2Xsize*2.0)) * (double)i / 20.0;
  1045.                 arParamObserv2Ideal( dist_factor, px, py, &x1, &y1 );
  1046.                 arParamObserv2Ideal( dist_factor, qx, py, &x2, &y2 );
  1047.                 arParamObserv2Ideal( dist_factor, qx, qy, &x3, &y3 );
  1048.                 arParamObserv2Ideal( dist_factor, px, qy, &x4, &y4 );
  1050.                 if( xwin == 0 && ywin == 0 ) {
  1051.                     xx1 = x1 * gZoom - 1.0;
  1052.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  1053.                     xx2 = x2 * gZoom - 1.0;
  1054.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  1055.                     xx3 = x3 * gZoom - 1.0;
  1056.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  1057.                     xx4 = x4 * gZoom - 1.0;
  1058.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  1059.                 }
  1060.                 else if( xwin == 1 && ywin == 0 ) {
  1061.                     xx1 = gXsize + x1 * gZoom - 1.0;
  1062.                     yy1 = (gWinYsize - 1) - y1 * gZoom;
  1063.                     xx2 = gXsize + x2 * gZoom - 1.0;
  1064.                     yy2 = (gWinYsize - 1) - y2 * gZoom;
  1065.                     xx3 = gXsize + x3 * gZoom - 1.0;
  1066.                     yy3 = (gWinYsize - 1) - y3 * gZoom;
  1067.                     xx4 = gXsize + x4 * gZoom - 1.0;
  1068.                     yy4 = (gWinYsize - 1) - y4 * gZoom;
  1069.                 }
  1070.                 else {
  1071.                     xx1 = (xwin-1)*gMiniXsize + x1*gZoom/(double)GMINI - 1.0;
  1072.                     xx2 = (xwin-1)*gMiniXsize + x2*gZoom/(double)GMINI - 1.0;
  1073.                     xx3 = (xwin-1)*gMiniXsize + x3*gZoom/(double)GMINI - 1.0;
  1074.                     xx4 = (xwin-1)*gMiniXsize + x4*gZoom/(double)GMINI - 1.0;
  1075.                     yy1 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y1*gZoom/(double)GMINI - 1.0;
  1076.                     yy2 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y2*gZoom/(double)GMINI - 1.0;
  1077.                     yy3 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y3*gZoom/(double)GMINI - 1.0;
  1078.                     yy4 = gWinYsize-gYsize-(ywin-1)*gMiniYsize - y4*gZoom/(double)GMINI - 1.0;
  1079.                 }
  1081.                 glBegin( GL_QUADS );
  1082.                 glTexCoord2d( tsx, tsy ); glVertex3d( xx1, yy1, z );
  1083.                 glTexCoord2d( tex, tsy ); glVertex3d( xx2, yy2, z );
  1084.                 glTexCoord2d( tex, tey ); glVertex3d( xx3, yy3, z );
  1085.                 glTexCoord2d( tsx, tey ); glVertex3d( xx4, yy4, z );
  1086.                 glEnd();
  1087.             }
  1088.         }
  1089.         glEndList();
  1090.         flag[mode][win] = 0;
  1091.     }
  1092.     else {
  1093.         glCallList( listIndex[mode][win] );
  1094.     }
  1096.     glBindTexture( GL_TEXTURE_2D, 0 );
  1097.     glDisable( GL_TEXTURE_2D );
  1098.     glPixelStorei( GL_UNPACK_ROW_LENGTH, 0 );
  1099. #ifndef _WIN32
  1100.     glPixelStorei( GL_UNPACK_IMAGE_HEIGHT, 0 );
  1101. #endif
  1102. }
  1104. void argDrawSquare( double  vertex[4][2], int xwin, int ywin )
  1105. {
  1106.     argLineSeg( vertex[0][0], vertex[0][1],
  1107.                 vertex[1][0], vertex[1][1], xwin, ywin );
  1108.     argLineSeg( vertex[1][0], vertex[1][1],
  1109.                 vertex[2][0], vertex[2][1], xwin, ywin );
  1110.     argLineSeg( vertex[2][0], vertex[2][1],
  1111.                 vertex[3][0], vertex[3][1], xwin, ywin );
  1112.     argLineSeg( vertex[3][0], vertex[3][1],
  1113.                 vertex[0][0], vertex[0][1], xwin, ywin );
  1114. }
  1116. void argLineSeg( double x1, double y1, double x2, double y2, int xwin, int ywin )
  1117. {
  1118.     float   ox, oy;
  1119.     double  xx1, yy1, xx2, yy2;
  1121.     if( argDrawMode == AR_DRAW_BY_TEXTURE_MAPPING ) {
  1122.         xx1 = x1;  yy1 = y1;
  1123.         xx2 = x2;  yy2 = y2;
  1124.     }
  1125.     else {
  1126.         arParamIdeal2Observ( gCparam.dist_factor, x1, y1, &xx1, &yy1 );
  1127.         arParamIdeal2Observ( gCparam.dist_factor, x2, y2, &xx2, &yy2 );
  1128.     }
  1130.     xx1 *= gZoom; yy1 *= gZoom;
  1131.     xx2 *= gZoom; yy2 *= gZoom;
  1133.     if( xwin == 0 && ywin == 0 ) {
  1134.         ox = 0;
  1135.         oy = gWinYsize-1;
  1136.         glBegin(GL_LINES);
  1137.           glVertex2f( ox+xx1, oy-yy1 );
  1138.           glVertex2f( ox+xx2, oy-yy2 );
  1139.         glEnd();
  1140.     }
  1141.     else {
  1142.         ox = (xwin-1)*gMiniXsize;
  1143.         oy = gWinYsize - gYsize -(ywin-1)*gMiniYsize - 1;
  1144.         glBegin(GL_LINES);
  1145.           glVertex2f( ox+xx1/GMINI, oy-yy1/GMINI );
  1146.           glVertex2f( ox+xx2/GMINI, oy-yy2/GMINI );
  1147.         glEnd();
  1148.     }
  1150.     glFlush();
  1151. }
  1153. void argLineSegHMD( double x1, double y1, double x2, double y2 )
  1154. {
  1155.     float   ox, oy;
  1157.     ox = 0;
  1158.     oy = gWinYsize - gYsize;
  1159.     glBegin(GL_LINES);
  1160.       glVertex2f( ox+x1, oy+y1 );
  1161.       glVertex2f( ox+x2, oy+y2 );
  1162.     glEnd();
  1163. }
  1166. static void argInitStencil(void)
  1167. {
  1168.     int     offset;
  1169.     int     i;
  1171.     glEnable(GL_STENCIL_TEST);
  1172.     glClearStencil(0);
  1173.     glClear(GL_STENCIL_BUFFER_BIT);
  1174.     glLineWidth(1.0);
  1176.     offset = gWinYsize - gYsize;
  1178. #if REVERSE_LR
  1179.     glStencilFunc(GL_ALWAYS, LEFTEYE, LEFTEYE);
  1180.     glStencilOp(GL_REPLACE, GL_REPLACE, GL_REPLACE);
  1181.     glBegin(GL_LINES);
  1182.     for( i = 0; i < gYsize; i+=2 ) {
  1183.         glVertex2f( 0.0,       (float)(i+offset) );
  1184.         glVertex2f( gWinXsize, (float)(i+offset) );
  1185.     }
  1186.     glEnd();
  1188.     glStencilFunc(GL_ALWAYS, RIGHTEYE, RIGHTEYE);
  1189.     glStencilOp(GL_REPLACE, GL_REPLACE, GL_REPLACE);
  1190.     glBegin(GL_LINES);
  1191.     for( i = 1; i < gYsize; i+=2 ) {
  1192.         glVertex2f( 0.0,       (float)(i+offset) );
  1193.         glVertex2f( gWinXsize, (float)(i+offset) );
  1194.     }
  1195.     glEnd();
  1196. #else
  1197.     glStencilFunc(GL_ALWAYS, LEFTEYE, LEFTEYE);
  1198.     glStencilOp(GL_REPLACE, GL_REPLACE, GL_REPLACE);
  1199.     glBegin(GL_LINES);
  1200.     for( i = 1; i < gYsize; i+=2 ) {
  1201.         glVertex2f( 0.0,       (float)(i+offset) );
  1202.         glVertex2f( gWinXsize, (float)(i+offset) );
  1203.     }
  1204.     glEnd();
  1206.     glStencilFunc(GL_ALWAYS, RIGHTEYE, RIGHTEYE);
  1207.     glStencilOp(GL_REPLACE, GL_REPLACE, GL_REPLACE);
  1208.     glBegin(GL_LINES);
  1209.     for( i = 0; i < gYsize; i+=2 ) {
  1210.         glVertex2f( 0.0,       (float)(i+offset) );
  1211.         glVertex2f( gWinXsize, (float)(i+offset) );
  1212.     }
  1213.     glEnd();
  1214. #endif
  1216.     glStencilFunc (GL_ALWAYS, 0, 0);
  1217.     glStencilOp (GL_KEEP, GL_KEEP, GL_KEEP);
  1218.     glDisable(GL_STENCIL_TEST);
  1219. }
  1221. void argLoadHMDparam( ARParam *lparam, ARParam *rparam )
  1222. {
  1223.     argConvGLcpara( lparam, AR_GL_CLIP_NEAR, AR_GL_CLIP_FAR, gl_lpara );
  1224.     argConvGLcpara( rparam, AR_GL_CLIP_NEAR, AR_GL_CLIP_FAR, gl_rpara );
  1226.     gl_hmd_para_flag = 1;
  1227. }
  1230. static void argSetStencil( int flag )
  1231. {
  1232.     if( flag == 0 ) {
  1233.         glDisable(GL_STENCIL_TEST);
  1234.         glStencilFunc (GL_ALWAYS, 0, 0);
  1235.         glStencilOp (GL_KEEP, GL_KEEP, GL_KEEP);
  1236.     }
  1237.     else {
  1238.         glEnable(GL_STENCIL_TEST);
  1239.         glStencilFunc (GL_EQUAL, flag, flag);
  1240.         glStencilOp (GL_KEEP, GL_KEEP, GL_KEEP);
  1241.     }
  1242. }
  1244. void argConvGLcpara( ARParam *param, double gnear, double gfar, double m[16] )
  1245. {
  1246.     argConvGLcpara2( param->mat, param->xsize, param->ysize, gnear, gfar, m );
  1247. }
  1249. static void argConvGLcpara2( double cparam[3][4], int width, int height, double gnear, double gfar, double m[16] )
  1250. {
  1251.     double   icpara[3][4];
  1252.     double   trans[3][4];
  1253.     double   p[3][3], q[4][4];
  1254.     int      i, j;
  1256.     if( arParamDecompMat(cparam, icpara, trans) < 0 ) {
  1257.         printf("gConvGLcpara: Parameter error!!n");
  1258.         exit(0);
  1259.     }
  1261.     for( i = 0; i < 3; i++ ) {
  1262.         for( j = 0; j < 3; j++ ) {
  1263.             p[i][j] = icpara[i][j] / icpara[2][2];
  1264.         }
  1265.     }
  1266.     q[0][0] = (2.0 * p[0][0] / width);
  1267.     q[0][1] = (2.0 * p[0][1] / width);
  1268.     q[0][2] = ((2.0 * p[0][2] / width)  - 1.0);
  1269.     q[0][3] = 0.0;
  1271.     q[1][0] = 0.0;
  1272.     q[1][1] = (2.0 * p[1][1] / height);
  1273.     q[1][2] = ((2.0 * p[1][2] / height) - 1.0);
  1274.     q[1][3] = 0.0;
  1276.     q[2][0] = 0.0;
  1277.     q[2][1] = 0.0;
  1278.     q[2][2] = (gfar + gnear)/(gfar - gnear);
  1279.     q[2][3] = -2.0 * gfar * gnear / (gfar - gnear);
  1281.     q[3][0] = 0.0;
  1282.     q[3][1] = 0.0;
  1283.     q[3][2] = 1.0;
  1284.     q[3][3] = 0.0;
  1286.     for( i = 0; i < 4; i++ ) {
  1287.         for( j = 0; j < 3; j++ ) {
  1288.             m[i+j*4] = q[i][0] * trans[0][j]
  1289.                      + q[i][1] * trans[1][j]
  1290.                      + q[i][2] * trans[2][j];
  1291.         }
  1292.         m[i+3*4] = q[i][0] * trans[0][3]
  1293.                  + q[i][1] * trans[1][3]
  1294.                  + q[i][2] * trans[2][3]
  1295.                  + q[i][3];
  1296.     }
  1297. }