int main(int argc, char *argv[])
{
glutInit(&argc, argv);
init(argc, argv);
argSetWindow(w1);
argSetDispFunc(mainLoop, 1);
argSetKeyFunc(keyEvent);
argSetWindow(w2);
argSetDispFunc(mainLoop, 1);
argSetKeyFunc(keyEvent);
count = 0;
fps[0] = '\0';
arVideoCapStart();
arUtilTimerReset();
argMainLoop();
return (0);
}
static void draw(ARdouble trans[3][4])
{
ARdouble gl_para[16];
GLfloat mat_diffuse[] = {0.0f, 0.0f, 1.0f, 0.0f};
GLfloat mat_flash[] = {1.0f, 1.0f, 1.0f, 0.0f};
GLfloat mat_flash_shiny[] = {50.0f};
GLfloat light_position[] = {100.0f, -200.0f, 200.0f, 0.0f};
GLfloat light_ambi[] = {0.1f, 0.1f, 0.1f, 0.0f};
GLfloat light_color[] = {1.0f, 1.0f, 1.0f, 0.0f};
argSetWindow(w1);
argDrawMode3D(vp1);
glClearDepth(1.0);
glClear(GL_DEPTH_BUFFER_BIT);
glEnable(GL_DEPTH_TEST);
glDepthFunc(GL_LEQUAL);
/* load the camera transformation matrix */
argConvGlpara(trans, gl_para);
glMatrixMode(GL_MODELVIEW);
#ifdef ARDOUBLE_IS_FLOAT
glLoadMatrixf(gl_para);
#else
glLoadMatrixd(gl_para);
#endif
glEnable(GL_LIGHTING);
glEnable(GL_LIGHT0);
glLightModeli(GL_LIGHT_MODEL_LOCAL_VIEWER, 1);
glLightfv(GL_LIGHT0, GL_POSITION, light_position);
glLightfv(GL_LIGHT0, GL_AMBIENT, light_ambi);
glLightfv(GL_LIGHT0, GL_DIFFUSE, light_color);
glLightfv(GL_LIGHT0, GL_SPECULAR, light_color);
glMaterialfv(GL_FRONT, GL_SPECULAR, mat_flash);
glMaterialfv(GL_FRONT, GL_SHININESS, mat_flash_shiny);
glMaterialfv(GL_FRONT, GL_DIFFUSE, mat_diffuse);
glMaterialfv(GL_FRONT, GL_AMBIENT, mat_diffuse);
#if 0
glTranslatef(0.0f, 0.0f, 40.0f);
glutSolidCube(80.0);
#else
glTranslatef(0.0f, 0.0f, 20.0f);
glRotatef(90.0f, 1.0f, 0.0f, 0.0f);
glutSolidTeapot(40.0);
#endif
glDisable(GL_LIGHT0);
glDisable(GL_LIGHTING);
glDisable(GL_DEPTH_TEST);
}
static void mainLoop(void)
{
ARUint8 *dataPtr;
ARMarkerInfo *markerInfo;
int markerNum;
ARdouble patt_trans[3][4];
ARdouble err;
int imageProcMode;
int debugMode;
int j, k;
/* grab a video frame */
if ((dataPtr = (ARUint8*)arVideoGetImage()) == NULL)
{
arUtilSleep(2);
return;
}
/* detect the markers in the video frame */
if (arDetectMarker(arHandle, dataPtr) < 0)
{
cleanup();
exit(0);
}
argSetWindow(w1);
argDrawMode2D(vp1);
arGetDebugMode(arHandle, &debugMode);
if (debugMode == 0)
{
argDrawImage(dataPtr);
}
else
{
arGetImageProcMode(arHandle, &imageProcMode);
if (imageProcMode == AR_IMAGE_PROC_FRAME_IMAGE)
{
argDrawImage(arHandle->labelInfo.bwImage);
}
else
{
argDrawImageHalf(arHandle->labelInfo.bwImage);
}
}
argSetWindow(w2);
argDrawMode2D(vp2);
argDrawImage(dataPtr);
argSetWindow(w1);
if (count % 10 == 0)
{
sprintf(fps, "%f[fps]", 10.0 / arUtilTimer());
arUtilTimerReset();
}
count++;
glColor3f(0.0f, 1.0f, 0.0f);
argDrawStringsByIdealPos(fps, 10, ysize - 30);
markerNum = arGetMarkerNum(arHandle);
if (markerNum == 0)
{
argSetWindow(w1);
argSwapBuffers();
argSetWindow(w2);
argSwapBuffers();
return;
}
/* check for object visibility */
markerInfo = arGetMarker(arHandle);
k = -1;
for (j = 0; j < markerNum; j++)
{
// ARLOG("ID=%d, CF = %f\n", markerInfo[j].id, markerInfo[j].cf);
if (patt_id == markerInfo[j].id)
{
if (k == -1)
{
if (markerInfo[j].cf > 0.7)
k = j;
}
else if (markerInfo[j].cf > markerInfo[k].cf)
k = j;
}
}
if (k == -1)
{
argSetWindow(w1);
argSwapBuffers();
argSetWindow(w2);
argSwapBuffers();
return;
}
err = arGetTransMatSquare(ar3DHandle, &(markerInfo[k]), patt_width, patt_trans);
sprintf(errValue, "err = %f", err);
glColor3f(0.0f, 1.0f, 0.0f);
argDrawStringsByIdealPos(fps, 10, ysize - 30);
argDrawStringsByIdealPos(errValue, 10, ysize - 60);
// ARLOG("err = %f\n", err);
draw(patt_trans);
argSetWindow(w1);
argSwapBuffers();
argSetWindow(w2);
argSwapBuffers();
}
static void mainLoop(void)
{
AR2VideoBufferT *buff;
ARMarkerInfo *markerInfo;
int markerNum;
ARdouble patt_trans[3][4];
ARdouble err;
int debugMode;
int j, k;
/* grab a video frame */
buff = arVideoGetImage();
if (!buff || !buff->fillFlag) {
arUtilSleep(2);
return;
}
/* detect the markers in the video frame */
if( arDetectMarker(arHandle, buff) < 0 ) {
cleanup();
exit(0);
}
argSetWindow(w1);
arGetDebugMode(arHandle, &debugMode);
if (debugMode == AR_DEBUG_ENABLE) {
int imageProcMode;
argViewportSetPixFormat(vp1, AR_PIXEL_FORMAT_MONO); // Drawing the debug image.
argDrawMode2D(vp1);
arGetImageProcMode(arHandle, &imageProcMode);
if (imageProcMode == AR_IMAGE_PROC_FRAME_IMAGE) argDrawImage(arHandle->labelInfo.bwImage);
else argDrawImageHalf(arHandle->labelInfo.bwImage);
} else {
AR_PIXEL_FORMAT pixFormat;
arGetPixelFormat(arHandle, &pixFormat);
argViewportSetPixFormat(vp1, pixFormat); // Drawing the input image.
argDrawMode2D(vp1);
argDrawImage(buff->buff);
}
argSetWindow(w2);
argDrawMode2D(vp2);
argDrawImage(buff->buff);
argSetWindow(w1);
if( count % 10 == 0 ) {
sprintf(fps, "%f[fps]", 10.0/arUtilTimer());
arUtilTimerReset();
}
count++;
glColor3f(0.0f, 1.0f, 0.0f);
argDrawStringsByIdealPos(fps, 10, ysize-30);
markerNum = arGetMarkerNum( arHandle );
if( markerNum == 0 ) {
argSetWindow(w1);
argSwapBuffers();
argSetWindow(w2);
argSwapBuffers();
return;
}
/* check for object visibility */
markerInfo = arGetMarker( arHandle );
k = -1;
for( j = 0; j < markerNum; j++ ) {
//ARLOG("ID=%d, CF = %f\n", markerInfo[j].id, markerInfo[j].cf);
if( patt_id == markerInfo[j].id ) {
if( k == -1 ) {
if (markerInfo[j].cf > 0.7) k = j;
} else if (markerInfo[j].cf > markerInfo[k].cf) k = j;
}
}
if( k == -1 ) {
argSetWindow(w1);
argSwapBuffers();
argSetWindow(w2);
argSwapBuffers();
return;
}
err = arGetTransMatSquare(ar3DHandle, &(markerInfo[k]), patt_width, patt_trans);
sprintf(errValue, "err = %f", err);
glColor3f(0.0f, 1.0f, 0.0f);
argDrawStringsByIdealPos(fps, 10, ysize-30);
argDrawStringsByIdealPos(errValue, 10, ysize-60);
//ARLOG("err = %f\n", err);
draw(patt_trans);
argSetWindow(w1);
argSwapBuffers();
argSetWindow(w2);
argSwapBuffers();
}
