/* keyboard events */
static void keyEvent( unsigned char key, int x, int y)
{
/* quit if the ESC key is pressed */
if( key == 0x1b ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
cleanup();
exit(0);
}
/* change the threshold value when 't' key pressed */
if( key == 't' ) {
printf("Enter new threshold value (default = 100): ");
scanf("%d",&thresh); while( getchar()!='\n' );
printf("\n");
}
/* turn on and off the debug mode with d key */
if( key == 'd' ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
arDebug = 1 - arDebug;
if( arDebug == 0 ) {
glClearColor( 0.0, 0.0, 0.0, 0.0 );
glClear(GL_COLOR_BUFFER_BIT);
argSwapBuffers();
glClear(GL_COLOR_BUFFER_BIT);
argSwapBuffers();
}
count = 0;
}
}
static void keyEvent( unsigned char key, int x, int y)
{
/* quit if the ESC key is pressed */
if( key == 0x1b ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
cleanup();
exit(0);
}
if( key == 'c' ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
count = 0;
mode = 1 - mode;
if( mode ) printf("Continuous mode: Using arGetTransMatCont.\n");
else printf("One shot mode: Using arGetTransMat.\n");
}
if(key == '1')
displayMode = 1;
if(key == '2')
displayMode = 2;
if(key == '3')
displayMode = 3;
if(key == 'k')
drawFromKinect = true;
if(key == 'c')
drawFromKinect = false;
}
/* main loop */
static void mainLoop(void)
{
int i, j, k;
if( count == 100 ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
count = 0;
}
if( count == 0 ) arUtilTimerReset();
count++;
argDrawMode2D();
argDispImage( dataPtr, 0, 0 );
/* if the debug mode is on draw squares
around the detected squares in the video image */
if( arDebug ) {
argDispImage( dataPtr, 1, 1 );
if( arImageProcMode == AR_IMAGE_PROC_IN_HALF )
argDispHalfImage( arImage, 2, 1 );
else
argDispImage( arImage, 2, 1);
glColor3f( 1.0, 0.0, 0.0 );
glLineWidth( 3.0 );
for( i = 0; i < marker_num; i++ ) {
if( marker_info[i].id < 0 ) continue;
argDrawSquare( marker_info[i].vertex, 2, 1 );
}
glLineWidth( 1.0 );
}
argSwapBuffers();
}
static void keyEvent( unsigned char key, int x, int y)
{
if( key == ' ' ) {
imgMode = (imgMode+1)%3;
gen_image( imgMode );
}
/* quit if the ESC key is pressed */
if( key == 0x1b ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
/* print out frame/sec and shut everything down */
cleanup();
exit(0);
}
/* turn on and off the debug mode with right mouse */
if( key == 'd' ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
arDebug = 1 - arDebug;
if( arDebug == 0 ) {
glClearColor( 0.0, 0.0, 0.0, 0.0 );
glClear(GL_COLOR_BUFFER_BIT);
argSwapBuffers();
glClear(GL_COLOR_BUFFER_BIT);
argSwapBuffers();
}
count = 0;
dispMode();
}
if( key == 'c' ) {
if( argDrawMode == AR_DRAW_BY_GL_DRAW_PIXELS ) {
argDrawMode = AR_DRAW_BY_TEXTURE_MAPPING;
argTexmapMode = AR_DRAW_TEXTURE_FULL_IMAGE;
}
else if( argTexmapMode == AR_DRAW_TEXTURE_FULL_IMAGE ) {
argTexmapMode = AR_DRAW_TEXTURE_HALF_IMAGE;
}
else {
argDrawMode = AR_DRAW_BY_GL_DRAW_PIXELS;
}
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
count = 0;
dispMode();
}
}
static void Keyboard(unsigned char key, int x, int y)
{
int mode;
switch (key) {
case 0x1B: // Quit.
case 'r':
knight->Reset();
case 'x':
knight->TranslateX(0.1);
break;
case 'y':
knight->TranslateY(0.1);
break;
case 'z':
knight->TranslateZ(0.1);
break;
case 'Q':
case 'q':
Quit();
break;
case ' ':
gDrawRotate = !gDrawRotate;
break;
case 'C':
case 'c':
mode = arglDrawModeGet(gArglSettings);
if (mode == AR_DRAW_BY_GL_DRAW_PIXELS) {
arglDrawModeSet(gArglSettings, AR_DRAW_BY_TEXTURE_MAPPING);
arglTexmapModeSet(gArglSettings, AR_DRAW_TEXTURE_FULL_IMAGE);
} else {
mode = arglTexmapModeGet(gArglSettings);
if (mode == AR_DRAW_TEXTURE_FULL_IMAGE) arglTexmapModeSet(gArglSettings, AR_DRAW_TEXTURE_HALF_IMAGE);
else arglDrawModeSet(gArglSettings, AR_DRAW_BY_GL_DRAW_PIXELS);
}
fprintf(stderr, "*** Camera - %f (frame/sec)\n", (double)gCallCountMarkerDetect/arUtilTimer());
gCallCountMarkerDetect = 0;
arUtilTimerReset();
debugReportMode();
break;
case 'D':
case 'd':
arDebug = !arDebug;
break;
case '?':
case '/':
printf("Keys:\n");
printf(" q or [esc] Quit demo.\n");
printf(" c Change arglDrawMode and arglTexmapMode.\n");
printf(" d Activate / deactivate debug mode.\n");
printf(" ? or / Show this help.\n");
printf("\nAdditionally, the ARVideo library supplied the following help text:\n");
arVideoDispOption();
break;
default:
break;
}
}
static void keyEvent( unsigned char key, int x, int y)
{
/* quit if the ESC key is pressed */
if( key == 0x1b ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
cleanup();
exit(0);
}
}
//=======================================================
// キーボード入力処理関数
//=======================================================
void KeyEvent( unsigned char key, int x, int y )
{
// ESCキーを入力したらアプリケーション終了
if (key == 0x1b ){
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
Cleanup();
exit(0);
}
}
static void keyEvent( unsigned char key, int x, int y)
{
/* quit if the ESC key is pressed */
if( key == 0x1b ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
cleanup();
exit(0);
}
if( key == 't' ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
printf("Enter new threshold value (current = %d): ", thresh);
scanf("%d",&thresh); while( getchar()!='\n' );
printf("\n");
count = 0;
}
/* turn on and off the debug mode with right mouse */
if( key == 'd' ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
arDebug = 1 - arDebug;
if( arDebug == 0 ) {
glClearColor( 0.0, 0.0, 0.0, 0.0 );
glClear(GL_COLOR_BUFFER_BIT);
argSwapBuffers();
glClear(GL_COLOR_BUFFER_BIT);
argSwapBuffers();
}
count = 0;
}
/* turn on and off the debug mode with right mouse */
if( key == 'f' ) {
if (mostraFantasmas == 0) mostraFantasmas = 1;
else mostraFantasmas = 0;
printf("*** Alterado modo fantasma: %b", mostraFantasmas);
}
}
int arGetCode( ARUint8 *image, int *x_coord, int *y_coord, int *vertex,
int *code, int *dir, double *cf )
{
#if DEBUG
static int count = 0;
static double a1 = 0.0;
static double a2 = 0.0;
double b1, b2, b3;
#endif
ARUint8 ext_pat[AR_PATT_SIZE_Y][AR_PATT_SIZE_X][3];
#if DEBUG
b1 = arUtilTimer();
#endif
arGetPatt(image, x_coord, y_coord, vertex, ext_pat);
#if DEBUG
b2 = arUtilTimer();
#endif
pattern_match((ARUint8 *)ext_pat, code, dir, cf);
#if DEBUG
b3 = arUtilTimer();
#endif
#if DEBUG
a1 += (b2 - b1);
a2 += (b3 - b2);
count++;
if( count == 60 ) {
printf("%10.5f[msec], %10.5f[msec]\n", a1*1000.0/60.0, a2*1000.0/60.0);
count = 0;
a1 = a2 = 0.0;
}
#endif
return(0);
}
/* main loop */
static void mainLoop(void)
{
if( count == 100 ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
count = 0;
}
if( count == 0 ) arUtilTimerReset();
count++;
rotate_angle+=1.;
if (rotate_angle>360)
{
rotate_angle=0.;
}
draw();
argSwapBuffers();
}
static void keyEvent( unsigned char key, int x, int y)
{
int i;
/* quit if the ESC key is pressed */
if( key == 0x1b ) {
printf("*** %f (frame/sec)\n", (double)count/arUtilTimer());
cleanup();
exit(0);
}
if (key == 's') {
if(flag_check){
printf("--------------(stop)------------------\n");
}else{
printf("--------------(start)-----------------\n");
}
flag_check = 1 - flag_check;
}
if (key == 'h'){
flag_hide = 1;
}
if (key == 'u'){
print_how_to_use();
}
if (key == 'p'){
printf("\n=====(LINES_POINT)=====\n");
for(i = 0; i < L_P_count; i++){
printf("%d : start %f %f %f\n", i, points[i].start_point[0], points[i].start_point[1], points[i].start_point[2] );
printf(" : end %f %f %f\n\n", points[i].end_point[0], points[i].end_point[1], points[i].end_point[2]);
}
printf("=========================\n");
}
if (key == 'a'){
flag_animation = 1 - flag_animation;
for(i = 0; i < L_P_count; i++){
myMoveBallInit( &points[i] );
}
}
}
static void Keyboard(unsigned char key, int x, int y)
{
int mode, threshChange = 0;
AR_LABELING_THRESH_MODE modea;
switch (key) {
case 0x1B: // Quit.
case 'Q':
case 'q':
cleanup();
exit(0);
break;
case 'X':
case 'x':
arGetImageProcMode(gARHandle, &mode);
switch (mode) {
case AR_IMAGE_PROC_FRAME_IMAGE: mode = AR_IMAGE_PROC_FIELD_IMAGE; break;
case AR_IMAGE_PROC_FIELD_IMAGE:
default: mode = AR_IMAGE_PROC_FRAME_IMAGE; break;
}
arSetImageProcMode(gARHandle, mode);
break;
case 'C':
case 'c':
ARLOGe("*** Camera - %f (frame/sec)\n", (double)gCallCountMarkerDetect/arUtilTimer());
gCallCountMarkerDetect = 0;
arUtilTimerReset();
break;
case 'a':
case 'A':
arGetLabelingThreshMode(gARHandle, &modea);
switch (modea) {
case AR_LABELING_THRESH_MODE_MANUAL: modea = AR_LABELING_THRESH_MODE_AUTO_MEDIAN; break;
case AR_LABELING_THRESH_MODE_AUTO_MEDIAN: modea = AR_LABELING_THRESH_MODE_AUTO_OTSU; break;
case AR_LABELING_THRESH_MODE_AUTO_OTSU: modea = AR_LABELING_THRESH_MODE_AUTO_ADAPTIVE; break;
case AR_LABELING_THRESH_MODE_AUTO_ADAPTIVE: modea = AR_LABELING_THRESH_MODE_AUTO_BRACKETING; break;
case AR_LABELING_THRESH_MODE_AUTO_BRACKETING:
default: modea = AR_LABELING_THRESH_MODE_MANUAL; break;
}
arSetLabelingThreshMode(gARHandle, modea);
break;
case '-':
threshChange = -5;
break;
case '+':
case '=':
threshChange = +5;
break;
case 'D':
case 'd':
arGetDebugMode(gARHandle, &mode);
arSetDebugMode(gARHandle, !mode);
break;
case '?':
case '/':
gShowHelp++;
if (gShowHelp > 1) gShowHelp = 0;
break;
case 'm':
case 'M':
gShowMode = !gShowMode;
break;
default:
break;
}
if (threshChange) {
int threshhold;
arGetLabelingThresh(gARHandle, &threshhold);
threshhold += threshChange;
if (threshhold < 0) threshhold = 0;
if (threshhold > 255) threshhold = 255;
arSetLabelingThresh(gARHandle, threshhold);
}
}
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)
{
static int ms_prev;
int ms;
float s_elapsed;
ARUint8 *image;
int i, j, k;
// Calculate time delta.
ms = glutGet(GLUT_ELAPSED_TIME);
s_elapsed = (float)(ms - ms_prev) * 0.001f;
ms_prev = ms;
// Grab a video frame.
if ((image = arVideoGetImage()) != NULL) {
gARTImage = image; // Save the fetched image.
// Calculate FPS every 30 frames.
if (gCallCountMarkerDetect % 30 == 0) {
gFPS = 30.0/arUtilTimer();
arUtilTimerReset();
gCallCountMarkerDetect = 0;
}
gCallCountMarkerDetect++; // Increment ARToolKit FPS counter.
// Run marker detection on frame
if (threadHandle) {
// Perform NFT tracking.
float err;
int ret;
int pageNo;
if( detectedPage == -2 ) {
trackingInitStart( threadHandle, gARTImage );
detectedPage = -1;
}
if( detectedPage == -1 ) {
ret = trackingInitGetResult( threadHandle, trackingTrans, &pageNo);
if( ret == 1 ) {
if (pageNo >= 0 && pageNo < surfaceSetCount) {
ARLOGd("Detected page %d.\n", pageNo);
detectedPage = pageNo;
ar2SetInitTrans(surfaceSet[detectedPage], trackingTrans);
} else {
ARLOGe("Detected bad page %d.\n", pageNo);
detectedPage = -2;
}
} else if( ret < 0 ) {
ARLOGd("No page detected.\n");
detectedPage = -2;
}
}
if( detectedPage >= 0 && detectedPage < surfaceSetCount) {
if( ar2Tracking(ar2Handle, surfaceSet[detectedPage], gARTImage, trackingTrans, &err) < 0 ) {
ARLOGd("Tracking lost.\n");
detectedPage = -2;
} else {
ARLOGd("Tracked page %d (max %d).\n", detectedPage, surfaceSetCount - 1);
}
}
} else {
ARLOGe("Error: threadHandle\n");
detectedPage = -2;
}
// Update markers.
for (i = 0; i < markersNFTCount; i++) {
markersNFT[i].validPrev = markersNFT[i].valid;
if (markersNFT[i].pageNo >= 0 && markersNFT[i].pageNo == detectedPage) {
markersNFT[i].valid = TRUE;
for (j = 0; j < 3; j++) for (k = 0; k < 4; k++) markersNFT[i].trans[j][k] = trackingTrans[j][k];
}
else markersNFT[i].valid = FALSE;
if (markersNFT[i].valid) {
// Filter the pose estimate.
if (markersNFT[i].ftmi) {
if (arFilterTransMat(markersNFT[i].ftmi, markersNFT[i].trans, !markersNFT[i].validPrev) < 0) {
ARLOGe("arFilterTransMat error with marker %d.\n", i);
}
}
if (!markersNFT[i].validPrev) {
// Marker has become visible, tell any dependent objects.
VirtualEnvironmentHandleARMarkerAppeared(i);
}
// We have a new pose, so set that.
arglCameraViewRH(markersNFT[i].trans, markersNFT[i].pose.T, VIEW_SCALEFACTOR);
// Tell any dependent objects about the update.
VirtualEnvironmentHandleARMarkerWasUpdated(i, markersNFT[i].pose);
} else {
if (markersNFT[i].validPrev) {
// Marker has ceased to be visible, tell any dependent objects.
VirtualEnvironmentHandleARMarkerDisappeared(i);
}
}
}
// Tell GLUT the display has changed.
glutPostRedisplay();
} else {
arUtilSleep(2);
}
}
static void Keyboard(unsigned char key, int x, int y)
{
int mode, threshChange = 0;
switch (key) {
case 0x1B: // Quit.
case 'Q':
case 'q':
cleanup();
exit(0);
break;
case ' ':
gDrawRotate = !gDrawRotate;
break;
case 'C':
case 'c':
ARLOGe("*** Camera - %f (frame/sec)\n", (double)gCallCountMarkerDetect/arUtilTimer());
gCallCountMarkerDetect = 0;
arUtilTimerReset();
debugReportMode(gARHandle);
break;
case '-':
threshChange = -5;
break;
case '+':
case '=':
threshChange = +5;
break;
case 'D':
case 'd':
arGetDebugMode(gARHandle, &mode);
arSetDebugMode(gARHandle, !mode);
break;
case 'B':
case 'b':
arGetLabelingMode(gARHandle, &mode);
if (mode == AR_LABELING_BLACK_REGION) arSetLabelingMode(gARHandle, AR_LABELING_WHITE_REGION);
else arSetLabelingMode(gARHandle, AR_LABELING_BLACK_REGION);
break;
case '?':
case '/':
ARLOG("Keys:\n");
ARLOG(" q or [esc] Quit demo.\n");
ARLOG(" c Calulcate frame rate.\n");
ARLOG(" - and + Adjust threshhold.\n");
ARLOG(" d Activate / deactivate debug mode.\n");
ARLOG(" b Toggle between detection of black markers and white markers.\n");
ARLOG(" ? or / Show this help.\n");
ARLOG("\nAdditionally, the ARVideo library supplied the following help text:\n");
arVideoDispOption();
break;
default:
break;
}
if (threshChange) {
int threshhold;
arGetLabelingThresh(gARHandle, &threshhold);
threshhold += threshChange;
if (threshhold < 0) threshhold = 0;
if (threshhold > 255) threshhold = 255;
arSetLabelingThresh(gARHandle, threshhold);
ARLOG("Threshhold changed to %d.\n", threshhold);
}
}
static void Keyboard(unsigned char key, int x, int y)
{
int mode, threshChange = 0;
AR_LABELING_THRESH_MODE modea;
switch (key) {
case 0x1B: // Quit.
case 'Q':
case 'q':
cleanup();
exit(0);
break;
case ' ':
gDrawRotate = !gDrawRotate;
break;
case 'X':
case 'x':
arGetImageProcMode(gARHandle, &mode);
switch (mode) {
case AR_IMAGE_PROC_FRAME_IMAGE: mode = AR_IMAGE_PROC_FIELD_IMAGE; break;
case AR_IMAGE_PROC_FIELD_IMAGE:
default: mode = AR_IMAGE_PROC_FRAME_IMAGE; break;
}
arSetImageProcMode(gARHandle, mode);
break;
case 'C':
case 'c':
mode = arglDrawModeGet(gArglSettings);
if (mode == AR_DRAW_BY_GL_DRAW_PIXELS) {
arglDrawModeSet(gArglSettings, AR_DRAW_BY_TEXTURE_MAPPING);
arglTexmapModeSet(gArglSettings, AR_DRAW_TEXTURE_FULL_IMAGE);
} else {
mode = arglTexmapModeGet(gArglSettings);
if (mode == AR_DRAW_TEXTURE_FULL_IMAGE) arglTexmapModeSet(gArglSettings, AR_DRAW_TEXTURE_HALF_IMAGE);
else arglDrawModeSet(gArglSettings, AR_DRAW_BY_GL_DRAW_PIXELS);
}
ARLOGe("*** Camera - %f (frame/sec)\n", (double)gCallCountMarkerDetect/arUtilTimer());
gCallCountMarkerDetect = 0;
arUtilTimerReset();
break;
case 'a':
case 'A':
arGetLabelingThreshMode(gARHandle, &modea);
switch (modea) {
case AR_LABELING_THRESH_MODE_MANUAL: modea = AR_LABELING_THRESH_MODE_AUTO_MEDIAN; break;
case AR_LABELING_THRESH_MODE_AUTO_MEDIAN: modea = AR_LABELING_THRESH_MODE_AUTO_OTSU; break;
case AR_LABELING_THRESH_MODE_AUTO_OTSU: modea = AR_LABELING_THRESH_MODE_AUTO_ADAPTIVE; break;
case AR_LABELING_THRESH_MODE_AUTO_ADAPTIVE: modea = AR_LABELING_THRESH_MODE_AUTO_BRACKETING; break;
case AR_LABELING_THRESH_MODE_AUTO_BRACKETING:
default: modea = AR_LABELING_THRESH_MODE_MANUAL; break;
}
arSetLabelingThreshMode(gARHandle, modea);
break;
case '-':
threshChange = -5;
break;
case '+':
case '=':
threshChange = +5;
break;
case 'D':
case 'd':
arGetDebugMode(gARHandle, &mode);
arSetDebugMode(gARHandle, !mode);
break;
case 's':
case 'S':
if (!gARTImageSavePlease) gARTImageSavePlease = TRUE;
break;
case '?':
case '/':
gShowHelp++;
if (gShowHelp > 1) gShowHelp = 0;
break;
case 'm':
case 'M':
gShowMode = !gShowMode;
break;
default:
break;
}
if (threshChange) {
int threshhold;
arGetLabelingThresh(gARHandle, &threshhold);
threshhold += threshChange;
if (threshhold < 0) threshhold = 0;
if (threshhold > 255) threshhold = 255;
arSetLabelingThresh(gARHandle, threshhold);
}
}
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();
}
/*
* Class: com_clab_artoolkit_port_JARToolkit
* Method: JARUtilTimer
* Signature: ()D
*/
JNIEXPORT jdouble JNICALL Java_net_sourceforge_jartoolkit_core_JARToolKit_utilTimer(JNIEnv *, jclass)
{
return arUtilTimer();
}
void MainLoop()
{
//QueryPerformanceFrequency(&nFreq);
//QueryPerformanceCounter(&nBefore);
DWORD StartTime,EndTime,PassTime;
double l_StartTime,l_EndTime,l_PassTime;
#ifdef _WIN32
StartTime=timeGetTime();
#else
l_StartTime=gettimeofday_sec();
#endif
ARUint8 *image;
ARMarkerInfo *marker_info;
int marker_num;
int j,k;
if( (image = (ARUint8*)arVideoGetImage() )==NULL){
arUtilSleep(2);
return;
}
argDrawMode2D();
argDispImage(image, 0, 0);
if(arDetectMarker(image, thresh, &marker_info, &marker_num) < 0){
CleanUp();
exit(0);
}
arVideoCapNext();
k=-1;
for(j=0;j<marker_num;j++){
if(patt_id==marker_info[j].id){
k = (k==-1) ? j : k;
k = (marker_info[k].cf < marker_info[j].cf) ? j: k;
}
}
if(k!=-1) {
if(isFirst==true)
nyar_NyARTransMat_O2_transMat(nyobj,&marker_info[k],patt_center,patt_width,patt_trans);
else
nyar_NyARTransMat_O2_transMatCont(nyobj,&marker_info[k],patt_trans,patt_center,patt_width,patt_trans);
isFirst=false;
if(GameOver==false){
if(arUtilTimer()>1.0){
MovePiece(3,f,p);
score+=f.ShiftPiece(f.deletePiece());
arUtilTimerReset();
GameOver=GameOverCheck(f,p);
}
}
else{
if(arUtilTimer()>15.0)
InitGame();
}
DrawObject();
}
argSwapBuffers();
#ifdef _WIN32
EndTime=timeGetTime();
PassTime=EndTime-StartTime;
(1000/FPS>PassTime)?Wait(1000/FPS-PassTime):Wait(0);
FPSCount(&fps);
printf("FPS=%d\n",fps);
#else
l_EndTime=gettimeofday_sec();
l_PassTime=l_EndTime-l_StartTime;
((double)(1000/FPS)>l_PassTime)?Wait((double)1000/FPS-l_PassTime):Wait(0);
FPSCount(&fps);
printf("FPS=%d\n",fps);
#endif
}