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

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

视频捕捉/采集

开发平台：

MultiPlatform

drawing.cpp：源码内容
  1. #include "drawing.h"
  2. #include <GL/glut.h>
  3. #include <math.h>
  4. #include "gsub.h"
  5. //#include "util.h"
  8. static GLUquadric *quadric = gluNewQuadric();
  11. void drawBullseye( double radius, int rings )
  12. {
  13.   int divs = ( rings * 2 ) - 1;
  14.   double r = radius / (double) divs;
  16.   gluQuadricDrawStyle( quadric, GLU_FILL );
  17.   gluQuadricOrientation( quadric, GLU_OUTSIDE );
  18.   gluQuadricNormals( quadric, GLU_SMOOTH );
  20.   glBlendFunc( GL_SRC_ALPHA, GL_ONE_MINUS_SRC_ALPHA );
  21.   glEnable( GL_BLEND );
  23.   glPushMatrix();
  24.   glTranslatef( 0.0, 0.0, -0.5 );
  25.   for( int i = 0 ; i < rings ; ++i )
  26.     gluDisk( quadric, i * 2 * r, ( i * 2 + 1 ) * r, 16, 1 );
  27.   // north marker
  28.   glBegin(GL_QUADS);
  29.     double w = radius/10;
  30.     double f = radius;
  31.     double t = radius*1.2;
  32.     glVertex3d(w, f, 0);
  33.     glVertex3d(w, t, 0);
  34.     glVertex3d(-w, t, 0);
  35.     glVertex3d(-w, f, 0);
  36.   glEnd();
  37.   glPopMatrix();
  39.   glDisable( GL_BLEND );
  40. }
  43. void drawMulti( ARMultiMarkerInfoT *m )
  44. {
  45.   double multiglmatrix[16];
  46.   double glmatrix[16];
  47.   argConvGlparad( m->trans, multiglmatrix );
  49.   argDrawMode3D();
  50.   argDraw3dCamera( 0, 0 );
  51.   glDepthFunc( GL_LEQUAL );
  52.   glEnable( GL_DEPTH_TEST );
  53.   glDisable( GL_TEXTURE_2D );
  54.   glDisable( GL_LIGHTING );
  55.   glDisable( GL_NORMALIZE );
  57.   glMatrixMode( GL_MODELVIEW );
  58.   glPushMatrix();
  59.   glMultMatrixd( multiglmatrix );
  61.   for( int i = 0 ; i < m->marker_num ; ++i )
  62.   {
  63.     double w = m->marker[i].width / 2.0;
  65.     if( m->marker[i].visible >= 0 )
  66.       glColor4f( 1.0, 1.0, 1.0, 0.3 );
  67.     else
  68.       glColor4f( 1.0, 1.0, 0.0, 0.1 );
  70.     argConvGlparad( m->marker[i].trans, glmatrix );
  71.     glPushMatrix();
  72.     glMultMatrixd( glmatrix );
  74.     drawBullseye( w * 1.5, 3 );
  75. /*
  76.     glBegin( GL_QUADS );
  77.       glVertex3f( m->marker[i].center[0] - w, 
  78.                   m->marker[i].center[1] - w,
  79.                   0.0
  80.                 );
  81.       glVertex3f( m->marker[i].center[0] + w, 
  82.                   m->marker[i].center[1] - w,
  83.                   0.0
  84.                 );
  85.       glVertex3f( m->marker[i].center[0] + w, 
  86.                   m->marker[i].center[1] + w,
  87.                   0.0
  88.                 );
  89.       glVertex3f( m->marker[i].center[0] - w, 
  90.                   m->marker[i].center[1] + w,
  91.                   0.0
  92.                 );
  93.     glEnd();
  94. */
  96.     glPopMatrix();
  97.   }
  99.   glPopMatrix();
  100. }
  103. void drawMarker( Marker *m )
  104. {
  105.   double w = m->width / 2.0;
  106.   double glmatrix[16];
  107.   argConvGlparad( m->trans, glmatrix );
  109.   argDrawMode3D();
  110.   argDraw3dCamera( 0, 0 );
  111.   glDepthFunc( GL_LEQUAL );
  112.   glEnable( GL_DEPTH_TEST );
  113.   glDisable( GL_TEXTURE_2D );
  114.   glDisable( GL_LIGHTING );
  115.   glDisable( GL_NORMALIZE );
  117.   glMatrixMode( GL_MODELVIEW );
  118.   glPushMatrix();   
  119.   glMultMatrixd( glmatrix );
  121.   glColor4f( 1.0, 0.0, 0.0, 0.5 );
  122.   drawBullseye( w * 1.5, 3 );
  124. /*
  125.   double b = 0;
  127.   glBegin( GL_QUADS );
  128.     glVertex3f( m->center[0] - w - b, m->center[1] - w - b, -0.1 );
  129.     glVertex3f( m->center[0] + w + b, m->center[1] - w - b, -0.1 );
  130.     glVertex3f( m->center[0] + w + b, m->center[1] + w + b, -0.1 );
  131.     glVertex3f( m->center[0] - w - b, m->center[1] + w + b, -0.1 );
  132.   glEnd();
  133. */
  134.       
  135.   glPopMatrix();
  136. }
  138. /*
  139. void selectDrawApp3d( app3dint *app, double trans[][4] )
  140. {
  141.   glMatrixMode( GL_PROJECTION );
  142.   glPushMatrix();
  144.   argDrawMode3D();
  145.   argMult3dCamera( 0, 0 );
  147.   glDepthFunc( GL_LEQUAL );
  148.   glEnable( GL_DEPTH_TEST );
  149.   glDisable( GL_LIGHTING );
  150.   glDisable( GL_TEXTURE_2D );
  151.   glDisable( GL_NORMALIZE );
  152.   glDisable( GL_CULL_FACE );
  154.   glMatrixMode( GL_MODELVIEW );
  155.   glPushMatrix();
  157.   app->drawFunc( trans );
  159.   glMatrixMode( GL_MODELVIEW );
  160.   glPopMatrix();
  162.   glMatrixMode( GL_PROJECTION );
  163.   glPopMatrix();
  164. } 
  165. */
  167. void enableLights()
  168. {
  169.   GLfloat ambient[4] = { 0.2, 0.2, 0.2, 1.0 };
  170.   glLightModelfv( GL_LIGHT_MODEL_AMBIENT, ambient );
  171.   
  172.   GLfloat light0[2][4] = { { 10.0, 10.0, -5.0,  0.0 },
  173.                            {  0.7,  0.7,  0.7,  1.0 } };
  174.   glLightfv( GL_LIGHT0, GL_POSITION, light0[0] );
  175.   glLightfv( GL_LIGHT0, GL_DIFFUSE,  light0[1] );
  176.   glLightfv( GL_LIGHT0, GL_SPECULAR, light0[1] );
  177.   glEnable( GL_LIGHT0 );
  178.   
  179.   GLfloat light1[2][4] = { { -10.0, -10.0, -10.0,  0.0 },
  180.                            {   0.7,   0.7,   0.7,  1.0 } };
  181.   glLightfv( GL_LIGHT1, GL_POSITION, light1[0] );
  182.   glLightfv( GL_LIGHT1, GL_DIFFUSE,  light1[1] );
  183.   glLightfv( GL_LIGHT1, GL_SPECULAR, light1[1] );
  184.   glEnable( GL_LIGHT1 ); 
  185.   
  186.   GLfloat light2[2][4] = { { -10.0,  10.0,  0.0,  0.0 },
  187.                            {   0.6,   0.5,  0.3,  1.0 } };
  188.   glLightfv( GL_LIGHT2, GL_POSITION, light2[0] );
  189.   glLightfv( GL_LIGHT2, GL_DIFFUSE,  light2[1] );
  190.   glLightfv( GL_LIGHT2, GL_SPECULAR, light2[1] );
  191.   glEnable( GL_LIGHT2 );
  192.   
  193.   GLfloat light3[2][4] = { {  10.0, -10.0,  0.0,  0.0 },
  194.                            {   0.4,   0.5,  0.6,  1.0 } };
  195.   glLightfv( GL_LIGHT3, GL_POSITION, light3[0] );
  196.   glLightfv( GL_LIGHT3, GL_DIFFUSE,  light3[1] );
  197.   glLightfv( GL_LIGHT3, GL_SPECULAR, light3[1] );
  198.   glEnable( GL_LIGHT3 );
  199. } 
  201. /*
  202. void drawApp3d( app3dint *app, double trans[][4] )
  203. {
  204.   argDrawMode3D();
  205.   argDraw3dCamera( 0, 0 );
  206.   
  207.   glDepthFunc( GL_LEQUAL );
  208.   glEnable( GL_DEPTH_TEST );
  209.   glEnable( GL_LIGHTING );
  210.   glEnable( GL_NORMALIZE );
  211.   glDisable( GL_TEXTURE_2D );
  212.   glDisable( GL_CULL_FACE );
  213.   
  214.   enableLights();
  215.   
  216.   glMatrixMode( GL_MODELVIEW );
  217.   glPushMatrix();
  218.   
  219.   app->drawFunc( trans );
  220.   
  221.   glMatrixMode( GL_MODELVIEW );
  222.   glPopMatrix();
  223. }
  226. static void calcNearnessTransform( double posA[3], double posB[3], 
  227.                                    double offset, double *dist )
  228. {   
  229.   double delta[3];
  230.   delta[0] = posA[0] - posB[0];
  231.   delta[1] = posA[1] - posB[1];
  232.   delta[2] = posA[2] - posB[2];
  233.   *dist = normalize( delta );  
  234.     
  235.   double midpoint[3];
  236.   midpoint[0] = ( posA[0] + posB[0] ) / 2.0;
  237.   midpoint[1] = ( posA[1] + posB[1] ) / 2.0;
  238.   midpoint[2] = ( posA[2] + posB[2] ) / 2.0;
  239.     
  240.   double Xvec[3] = { 1.0, 0.0, 0.0 };
  241.   double Yvec[3] = { 0.0, 1.0, 0.0 };
  242.   double Zvec[3] = { 0.0, 0.0, 1.0 };
  243.   
  244.   double normal[3];   
  245.   crossprod( delta, Yvec, normal );
  246.   normalize( normal );
  247.     
  248.   double rotvec[3];
  249.   crossprod( normal, Zvec, rotvec );
  250.   
  251.   double NdotZ = dotprod( normal, Zvec );
  252.   double angle = - acos( NdotZ ) * 180.0 / M_PI;
  253.     
  254.   double plane[3];
  255.   crossprod( normal, delta, plane );
  256.   normalize( plane );
  257.     
  258.   double sign;
  259.   if( dotprod( delta, Xvec ) < 0 )
  260.     sign = 1;
  261.   else
  262.     sign = -1;
  264.   double theta;
  265.   if( dotprod( plane, Xvec ) < 0 )
  266.     theta = sign * - acos( dotprod( plane, Yvec ) ) * 180.0 / M_PI;
  267.   else
  268.     theta = sign * acos( dotprod( plane, Yvec ) ) * 180.0 / M_PI;
  270.   glTranslatef( plane[0] * offset, plane[1] * offset, plane[2] * offset );  
  271.   glTranslatef( midpoint[0], midpoint[1], midpoint[2] );
  272.   glRotatef( angle, rotvec[0], rotvec[1], rotvec[2] );
  273.   glRotatef( theta, 0.0, 0.0, 1.0 );
  274. } 
  277. void drawNearness( double posA[3], double posB[3] )
  278. {
  279.   GLfloat color[4] = {  0.2,  0.9,  0.4,  1.0 };
  280.                 
  281.   glMaterialfv( GL_FRONT_AND_BACK, GL_AMBIENT,   color );
  282.   glMaterialfv( GL_FRONT_AND_BACK, GL_DIFFUSE,   color );
  283.   glMaterialfv( GL_FRONT_AND_BACK, GL_SPECULAR,  color );
  284.   glMaterialfv( GL_FRONT_AND_BACK, GL_EMISSION,  glBlack );
  285.   glMaterialf ( GL_FRONT_AND_BACK, GL_SHININESS, 0.5 * 128.0 );
  286.                 
  287.   gluQuadricDrawStyle( quadric, GLU_FILL );
  288.   gluQuadricOrientation( quadric, GLU_OUTSIDE );
  289.   gluQuadricNormals( quadric, GLU_SMOOTH );
  290.     
  291.   glDepthFunc( GL_LEQUAL );
  292.   glEnable( GL_DEPTH_TEST );
  293.   glEnable( GL_NORMALIZE );
  294.   glEnable( GL_LIGHTING );
  295.   glDisable( GL_TEXTURE_2D );
  296.   glDisable( GL_CULL_FACE );
  297.   
  298.   argDrawMode3D();
  299.   argDraw3dCamera( 0, 0 );
  300.   
  301.   enableLights();
  303.   glMatrixMode( GL_MODELVIEW );  
  304.   glPushMatrix();
  306.   double diameter;
  307.   calcNearnessTransform( posA, posB, -25.0, &diameter );
  308.   
  309.   GLdouble clipplane[4] = { 0.0, -1.0, 0.0, 0.0 };
  310.   glClipPlane( GL_CLIP_PLANE0, clipplane );
  311.   glEnable( GL_CLIP_PLANE0 );
  312.   
  313.   glutSolidTorus( 5.0, diameter / 2.0, 16, 24 );
  314.  
  315.   glDisable( GL_CLIP_PLANE0 );
  317.   glPushMatrix();
  318.     glTranslatef( diameter / 2.0, 0.0, 0.0 );
  319.     glRotatef( -90.0, 1.0, 0.0, 0.0 );
  320.     gluCylinder( quadric, 10.0, 0.0, 25.0, 16, 1 );
  321.     gluDisk( quadric, 0, 10.0, 16, 1 );
  322.   glPopMatrix();
  323.   
  324.   glPushMatrix();
  325.     glTranslatef( -diameter / 2.0, 0.0, 0.0 );
  326.     glRotatef( -90.0, 1.0, 0.0, 0.0 );
  327.     gluCylinder( quadric, 10.0, 0.0, 25.0, 16, 1 );
  328.     gluDisk( quadric, 0, 10.0, 16, 1 );
  329.   glPopMatrix();
  330.    
  331.   glPopMatrix();  
  332. } 
  333. */