static void mainLoop( void )
{
AR2VideoBufferT *videoBuffL;
AR2VideoBufferT *videoBuffR;
ARUint8 *dataPtrL;
ARUint8 *dataPtrR;
int cornerFlagL;
int cornerFlagR;
int cornerCountL;
int cornerCountR;
char buf[256];
int i;
if ((videoBuffL = ar2VideoGetImage(vidL))) {
gVideoBuffL = videoBuffL;
}
if ((videoBuffR = ar2VideoGetImage(vidR))) {
gVideoBuffR = videoBuffR;
}
if (gVideoBuffL && gVideoBuffR) {
// Warn about significant time differences.
i = ((int)gVideoBuffR->time_sec - (int)gVideoBuffL->time_sec) * 1000
+ ((int)gVideoBuffR->time_usec - (int)gVideoBuffL->time_usec) / 1000;
if( i > 20 ) {
ARLOG("Time diff = %d[msec]\n", i);
} else if( i < -20 ) {
ARLOG("Time diff = %d[msec]\n", i);
}
dataPtrL = gVideoBuffL->buff;
dataPtrR = gVideoBuffR->buff;
glClear(GL_COLOR_BUFFER_BIT);
argDrawMode2D( vpL );
argDrawImage( dataPtrL );
argDrawMode2D( vpR );
argDrawImage( dataPtrR );
copyImage( dataPtrL, (ARUint8 *)calibImageL->imageData, xsizeL*ysizeL, pixFormatL );
cornerFlagL = cvFindChessboardCorners(calibImageL, cvSize(chessboardCornerNumY,chessboardCornerNumX),
cornersL, &cornerCountL, CV_CALIB_CB_ADAPTIVE_THRESH|CV_CALIB_CB_FILTER_QUADS );
copyImage( dataPtrR, (ARUint8 *)calibImageR->imageData, xsizeR*ysizeR, pixFormatR );
cornerFlagR = cvFindChessboardCorners(calibImageR, cvSize(chessboardCornerNumY,chessboardCornerNumX),
cornersR, &cornerCountR, CV_CALIB_CB_ADAPTIVE_THRESH|CV_CALIB_CB_FILTER_QUADS );
argDrawMode2D( vpL );
if(cornerFlagL) glColor3f(1.0f, 0.0f, 0.0f);
else glColor3f(0.0f, 1.0f, 0.0f);
glLineWidth(2.0f);
//ARLOG("Detected corners = %d\n", cornerCount);
for( i = 0; i < cornerCountL; i++ ) {
argDrawLineByObservedPos(cornersL[i].x-5, cornersL[i].y-5, cornersL[i].x+5, cornersL[i].y+5);
argDrawLineByObservedPos(cornersL[i].x-5, cornersL[i].y+5, cornersL[i].x+5, cornersL[i].y-5);
//ARLOG(" %f, %f\n", cornersL[i].x, cornersL[i].y);
sprintf(buf, "%d\n", i);
argDrawStringsByObservedPos(buf, cornersL[i].x, cornersL[i].y+20);
}
argDrawMode2D( vpR );
if(cornerFlagR) glColor3f(1.0f, 0.0f, 0.0f);
else glColor3f(0.0f, 1.0f, 0.0f);
glLineWidth(2.0f);
//ARLOG("Detected corners = %d\n", cornerCount);
for( i = 0; i < cornerCountR; i++ ) {
argDrawLineByObservedPos(cornersR[i].x-5, cornersR[i].y-5, cornersR[i].x+5, cornersR[i].y+5);
argDrawLineByObservedPos(cornersR[i].x-5, cornersR[i].y+5, cornersR[i].x+5, cornersR[i].y-5);
//ARLOG(" %f, %f\n", cornersR[i].x, cornersR[i].y);
sprintf(buf, "%d\n", i);
argDrawStringsByObservedPos(buf, cornersR[i].x, cornersR[i].y+20);
}
if( cornerFlagL && cornerFlagR ) {
cornerFlag = 1;
glColor3f(1.0f, 0.0f, 0.0f);
}
else {
cornerFlag = 0;
glColor3f(0.0f, 1.0f, 0.0f);
}
argDrawMode2D( vpL );
sprintf(buf, "Captured Image: %2d/%2d\n", capturedImageNum, calibImageNum);
argDrawStringsByIdealPos(buf, 10, 30);
argSwapBuffers();
gVideoBuffL = gVideoBuffR = NULL;
} else arUtilSleep(2);
}
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();
}
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 AR2VideoBufferT buff = {0};
static int oldImageMode = -1;
static int oldDispMode = -1;
static int oldDistMode = -1;
ARdouble patt_trans[3][4];
int i, j;
if (!buff.buff) {
arMalloc(buff.buff, ARUint8, xsize*ysize*PIXEL_SIZE);
}
if( oldImageMode != 0 && imageMode == 0 ) {
for( i = 0; i < xsize*ysize; i++ ) {
buff.buff[i*PIXEL_SIZE+0] = 200;
buff.buff[i*PIXEL_SIZE+1] = 200;
buff.buff[i*PIXEL_SIZE+2] = 200;
}
for( j = 190; j < 291; j++ ) {
for( i = 280; i < 381; i++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 20;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 20;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 20;
}
}
i = 0;
for( j = 0; j < ysize; j++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 255;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 0;
}
i = 639;
for( j = 0; j < ysize; j++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 255;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 0;
}
j = 0;
for( i = 0; i < xsize; i++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 255;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 0;
}
j = 479;
for( i = 0; i < xsize; i++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 255;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 0;
}
oldImageMode = 0;
}
if( oldImageMode != 1 && imageMode == 1 ) {
for( j = 0; j < 480; j += 2 ) {
for( i = 0; i < 640; i++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 255;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 0;
}
}
for( j = 1; j < 480; j += 2 ) {
for( i = 0; i < 640; i++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 255;
}
}
oldImageMode = 1;
}
if( oldImageMode != 2 && imageMode == 2 ) {
for( i = 0; i < 640; i += 2 ) {
for( j = 0; j < 480; j++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 255;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 0;
}
}
for( i = 1; i < 640; i += 2 ) {
for( j = 0; j < 480; j++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 0;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 255;
}
}
oldImageMode = 2;
}
if( oldImageMode != 3 && imageMode == 3 ) {
for( i = 0; i < xsize*ysize; i++ ) {
buff.buff[i*PIXEL_SIZE+0] = 200;
buff.buff[i*PIXEL_SIZE+1] = 200;
buff.buff[i*PIXEL_SIZE+2] = 200;
}
for( j = 190; j < 291; j++ ) {
for( i = 280; i < 381; i++ ) {
buff.buff[(j*xsize+i)*PIXEL_SIZE+0] = 20;
buff.buff[(j*xsize+i)*PIXEL_SIZE+1] = 20;
buff.buff[(j*xsize+i)*PIXEL_SIZE+2] = 20;
}
}
oldImageMode = 3;
}
/* detect the markers in the video frame */
if (arDetectMarker(arHandle, &buff) < 0) {
cleanup();
exit(0);
}
glClearColor( 0.0f, 0.0f, 0.0f, 0.0f );
glClearDepth( 1.0f );
glClear(GL_COLOR_BUFFER_BIT|GL_DEPTH_BUFFER_BIT);
if( oldDispMode != 0 && dispMode == 0 ) {
argViewportSetDispMethod( vp, AR_GL_DISP_METHOD_GL_DRAW_PIXELS );
oldDispMode = 0;
debugReportMode(vp);
}
else if( oldDispMode != 1 && dispMode == 1 ) {
argViewportSetDispMethod( vp, AR_GL_DISP_METHOD_TEXTURE_MAPPING_FRAME );
oldDispMode = 1;
debugReportMode(vp);
}
else if( oldDispMode != 2 && dispMode == 2 ) {
argViewportSetDispMethod( vp, AR_GL_DISP_METHOD_TEXTURE_MAPPING_FIELD );
oldDispMode = 2;
debugReportMode(vp);
}
if( oldDistMode != 0 && distMode == 0 ) {
argViewportSetDistortionMode( vp, AR_GL_DISTORTION_COMPENSATE_DISABLE );
oldDistMode = 0;
}
if( oldDistMode != 1 && distMode == 1 ) {
argViewportSetDistortionMode( vp, AR_GL_DISTORTION_COMPENSATE_ENABLE );
oldDistMode = 1;
}
argDrawMode2D(vp);
argDrawImage(buff.buff);
if( imageMode == 3 ) {
glLineWidth( 1.0f );
glColor3f( 0.0f, 1.0f, 0.0f );
argDrawSquareByIdealPos( arHandle->markerInfo[0].vertex );
glColor3f( 1.0f, 0.0f, 0.0f );
argDrawLineByIdealPos( 0.0, 0.0, 640.0, 0.0 );
argDrawLineByIdealPos( 0.0, 479.0, 640.0, 479.0 );
argDrawLineByIdealPos( 0.0, -1.0, 0.0, 479.0 );
argDrawLineByIdealPos( 639.0, -1.0, 639.0, 479.0 );
argDrawLineByIdealPos( 0.0, 188.0, 639.0, 188.0 );
argDrawLineByIdealPos( 0.0, 292.0, 639.0, 292.0 );
argDrawLineByIdealPos( 278.0, 0.0, 278.0, 479.0 );
argDrawLineByIdealPos( 382.0, 0.0, 382.0, 479.0 );
}
if( arHandle->marker_num == 0 ) {
argSwapBuffers();
return;
}
arGetTransMatSquare(ar3DHandle, &(arHandle->markerInfo[0]), SQUARE_WIDTH, patt_trans);
draw(patt_trans);
argSwapBuffers();
}
