#include "opencv/cv.h"  // include core library interface

#include "opencv/highgui.h" // include GUI library interface

#include <stdio.h>

#include <math.h>

#include <string.h>

const int MAX_CORNERS = 500;

int main(int argc, char* argv[])

{

        // Load two images and allocate other structures

        IplImage* imgA = cvLoadImage("sample1.bmp", CV_LOAD_IMAGE_GRAYSCALE);

        CvSize img_sz = cvGetSize( imgA );

        int win_size = 15;

        IplImage* eig_image = cvCreateImage( img_sz, IPL_DEPTH_32F, 1 );

        IplImage* tmp_image = cvCreateImage( img_sz, IPL_DEPTH_32F, 1 );

        int corner_count = MAX_CORNERS;

        CvPoint2D32f* cornersA = new CvPoint2D32f[ MAX_CORNERS ];

        cvGoodFeaturesToTrack( imgA, eig_image, tmp_image, cornersA, &corner_count,

                0.05, 5.0, 0, 3, 0, 0.04 );

        printf("Debug 1\n");

        cvFindCornerSubPix( imgA, cornersA, corner_count, cvSize( win_size, win_size ),

                cvSize( -1, -1 ), cvTermCriteria( CV_TERMCRIT_ITER | CV_TERMCRIT_EPS, 20, 0.03 ) );

        printf("Debug 2\n");

        return 0;

}