10/27/2011

Sift matching C++ source code / using opencv library

Created Date : 2011.10
Language : C/C++
Tool : Microsoft Visual C++ 2008
Library & Utilized : OpenCV 2.3
Reference : SIFT reference
etc. : template Image, WebCam







I made SIFT matching program using OpenCV 2.3.
I was wondering how to know the object pose.
In the internet, there are many source about sift, surf. But most of code introduced about only descripter and matching. There is no code to find object pose.
So I made this code and I should disclose this code.


This code uses openCV functions very useful.
cvExtractSURF, cvFindHomography...

I made matching code to the class. Class file name is MareMatchingClass.h/cpp.
You can use my class in the source very easily.

1. Create Matching class
   CMareMatchingClass MMathing;   

2.Input PatchImg
   MMathing.ExtractPatchSurf(PatchImg);

3.Find PatchImg in the background img
   MMathing.GetObjectRectAndBestH(BackGroundImg, &rect4pt);

4.Drawing the rect(rect4pt).
5.Repeat, go to the 3.

The class is consist of like below process;
1. Extract Feature -> use cvExtractSURF function
2. Find Matching point
3. Select some feature in the mached feature points, randomly.
4. calculate Homography matrix. This is geometry relationship between patch and background image.
5. transform features in the patch image by Homography matrix.
6. compare the transformed features to the background features.
7. evaluate how much is the homography exact.
7. repeat 4~6 and select best H.


<source code>

I think the source code is not best.
There are still shortage the source code.
It would need futher improvemnet.
so I want to discuss with you. Please leave your valueable opinion.
Thank you.
Have a nice day~. ^^

Oh~ english is very difficult.....


10/21/2011

STL vector(with 2 more elements) sorting code / STLμ—μ„œ 2개 μ΄μƒμ˜ μ—˜λ¦¬λ¨ΌνŠΈλ₯Ό 가지고 μžˆλŠ” vector μ •λ ¬ code

The source is simple but I always don't remember the code well.
If you similar to me, refer to my code easily.


#include <iostream>
#include <cmath>
#include <time.h>
#include <vector>
#include <algorithm>
using namespace std;

class element{
public:
    element(float a, int b){
        value = a;
        index = b;
    }
    float value;
    int index;
};

bool compare(const element &a, const element &b )
{
    return a.value < b.value; //μ˜€λ¦„μ°¨μˆœ(ascending order)
    //return a.value > b.value; //λ‚΄λ¦Όμ°¨μˆœ(descending order)
}

void main()
{
    srand( (unsigned int)time(NULL));

    vector< element > A;

    // κ°’ λ„£κΈ° (input value)/////////////////////////////////////////////
    for(int i=0; i<20000; ++i){
        A.push_back( element(rand()%10, i) );
    }


    //κ°’ 좜λ ₯  (data print)///////////////////////////////////////////////
    printf("μ •λ ¬ μ „(Before ordering) \n");
    for(i=0; i<20000; ++i){
        printf("A[%d] -> value %f :: index -> %d\n", i, A[i].value, A[i].index );
    }


    //μ •λ ¬ (sorting)
    sort(A.begin(),A.end(),compare);


    //κ°’ 좜λ ₯ (Value print)
    printf("μ •λ ¬ ν›„(After ordering)\n");
    for(i=0; i<20000; ++i){
        printf("A[%d] -> value %f :: index -> %d\n", i, A[i].value, A[i].index );
    }
      
}

10/19/2011

Incremental K-means matlab source code

Created Date : 2011.10.
Language : Matlab 2010
Tool : -
Library & Utilized :-
Reference :An Incremental K-means algorithm(D.T. Pham, S.S. Dimov and C.D. Nguyen)
Etc. :-




I made Incremental K-means algorithm as matlab source code.
I made the code base on above table which is introduced in the paper.
The incremental K-means is similar to K-means but the different point is number of cluster class is increasing. but we have to set the maximum number.

Below figure is result of clustering. the sample data is normal vector of the 3D point that is acquied by bumblebee.
I think the K-means algorithm is sensitive to error or outlier data. because the algorithm use euclidean distance. and The result of clustering is different every time because the initial position of the class is selected randomly.

I hope my code help to your problem and study.
thank you.
Give me your valuable comments. ^^

<source code>
Clustering result of the sample datas.





enlarge image of the above figure




10/17/2011

BumBleBee 2D, 3D data acquisition source code / λ²”λΈ”λΉ„ 2D, 3D 데이터 νšλ“ μ†ŒμŠ€

Created Date : 2009.10.
Language : C++
Tool : Visual Studio C++ 2008
Library & Utilized : Point Grey-FlyCapture, Triclops, OpenCV 2.1
Reference : PointGrey Bumblebee Reference, www.cylod.com, www.ptgrey.com/
Etc. : STL



BumBleBee Stereo Camera Data Acquisition Source code.



This is Stereo Camera. The name is BumBleBee. This is product of PointGrey Company.
This camera is IEEE 1394 capble type.
This camera can obtain 3D cloud data rapidly and continously.

I need 2 library for using this camera(Triclops SDK, FlyCapture).
You can download these libs on the www.ptgrey.com site(support).
You have to use my source after install libs. and you have to set path(To include directory, lib directory). and you also need opencv 2.1 lib.

I made the acquisition code as class. The class name is CSensorStereo2.
You can use this class like below source code.
The sequence is 'Open->GetData->Close'.
I did that 2D data save Iplimage in opencv and 3D depth data save as Txt file.
The source code is very easy to use ^^.
If you have any question, Plz give your comments to me.

Thank you.

source code is shared on Github
https://github.com/MareArts/Bumblebee_GetDataClass



#include <stdio.h>
#include "SensorStereo2.h"
#include <time.h>

void main()
{

int Width = 320;
int Height = 240; 

CSensorStereo2 CSS2;
CSS2.Initial(Width,Height); 
CSS2.Open();

cvNamedWindow("Reference");
char str[1000];

while(1) {

//get 1 frame data(Image, Depth information)
CSS2.GetData();

//Show Image
cvShowImage("Reference",CSS2.ImgReference); 

//Save Depth
sprintf(str,"./DepthData/%d_Depth.txt",time(0));
printf("%s\n", str);

FILE * fp; fp = fopen(str,"w");
for(int i=0; i<Width; ++i)
{ 
  for(int j=0; j<Height; ++j)
  {
    fprintf(fp,"%lf %lf %lf\n", CSS2.pDepth[i][j].x, CSS2.pDepth[i][j].y, CSS2.pDepth[i][j].z );
  } 
}

fclose(fp);

if(cvWaitKey(1) >= 0 )
   break;
}

cvDestroyWindow("Reference");
CSS2.Close();
}















 

10/13/2011

Catmull-Rom Spline interpolation/ C++ source code/ μŠ€ν”ŒλΌμΈ 보간

Created Date : 2010.11.
Language : C++
Tool : Visual Studio C++ 2008
Library & Utilized : -
Reference :Catmull-Rom Spline reference
Etc. : STL





This program is Catmull-Rom Spline code.
Please search detail contents about Catmull-Rom Spline in the internet. ^^
In the main.cpp, the source code consisted of Input, calculate spline and output.
In the function of Catmull-Rom Spline, parameters means coordinate(x,y), Step, number of interpolation in a section.

You can get interpolation points easily using this function(PathToCurve).


--------------------------------------------------------------------
이 μ†ŒμŠ€ μ½”λ“œλŠ” Catmull-Rom 보간법을 ν”„λ‘œκ·Έλž˜λ° ν•œ 것 μž…λ‹ˆλ‹€.
이둠적인 λ‚΄μš©μ€ 인터넷을 κ²€μƒ‰ν•˜μ‹œλ©΄ λ§Žμ€ 자료λ₯Ό 찾을 수 μžˆμ–΄μ„œ μƒλž΅ν•©λ‹ˆλ‹€.
메인 ν•¨μˆ˜μ—λŠ” μž…λ ₯, 보간, 좜λ ₯으둜 κ΅¬μ„±λ˜μ–΄ 있고, μž…λ ₯을 μ›ν•˜λŠ” μ’Œν‘œ 값을 μž…λ ₯ν•˜μ—¬ ν•΄λ‹Ή λ¬Έμ œμ— μ μš©ν•˜μ‹œλ©΄λ  κ±°μ˜ˆμš”.
보간 ν•¨μˆ˜λŠ” μ’Œν‘œ, μŠ€ν…,ν•œ ꡬ간 보간 갯수λ₯Ό μž…λ ₯ν•˜λ„λ‘ ν•˜μ˜€μŠ΅λ‹ˆλ‹€.
λ§€νŠΈλž©μ„ ν†΅ν•˜μ—¬ 보간결과λ₯Ό ν™•μΈν•΄λ³΄μ„Έμš”.
κ°„λ‹¨ν•œ 맀트랩 νŒŒμΌλ„ μ²¨λΆ€ν•©λ‹ˆλ‹€.

쒋은 λ‹΅λ³€ λ°”λžλ‹ˆλ‹€. ^^


*main
/////////////////////////////////////////////////////////////////////////
//input
vector< pair<double , double > > InputPath;
FILE * fp1;
fp1 = fopen("input2.txt","r");
double x,y;
while( fscanf(fp1,"%lf %lf", &x, &y)!=EOF )
{
//printf("%lf %lf\n", x,y);
InputPath.push_back( make_pair(x,y) );
}
fclose(fp1);


//////////////////////////////////////////////////////////////////////////
//Spline
vector< pair<double , double > > curvePath;
curvePath = PathToCurve( InputPath, 1, 10);



//////////////////////////////////////////////////////////////////////////
//output
FILE* fp2;
fp2 = fopen("out.txt","w");
for(int i=0; i<curvePath.size(); ++i)
{
fprintf(fp2, "%lf %lf\n", curvePath[i].first, curvePath[i].second );
//printf("%lf %lf\n", curvePath[i].first, curvePath[i].second );
}
fclose(fp2);

*input
5 6
3 4
3 2
5 2
7 4

*output
1.000000 1.000000
1.174000 1.201000
1.392000 1.488000
1.648000 1.837000
1.936000 2.224000
2.250000 2.625000
2.584000 3.016000
2.932000 3.373000
3.288000 3.672000
3.646000 3.889000
4.000000 4.000000
4.359500 3.984500
4.736000 3.856000
5.126500 3.641500
5.528000 3.368000
5.937500 3.062500
6.352000 2.752000
6.768500 2.463500
7.184000 2.224000
7.595500 2.060500
8.000000 2.000000
8.400000 2.056000
8.800000 2.208000
9.200000 2.432000
9.600000 2.704000
10.000000 3.000000
10.400000 3.296000
10.800000 3.568000
11.200000 3.792000
11.600000 3.944000
12.000000 4.000000
12.418000 3.953000
12.864000 3.824000
13.326000 3.631000
13.792000 3.392000
14.250000 3.125000
14.688000 2.848000
15.094000 2.579000
15.456000 2.336000
15.762000 2.137000
16.000000 2.000000


plz give me your valuable comment. Thank you.





10/11/2011

Rect Corner Detection / C++, OpenCV1.0 / μ‚¬κ°ν˜• λͺ¨μ„œλ¦¬ μ°ΎκΈ°

Created Date : 2008.11.
Language : C++
Tool : Visual Studio C++6.0
Library & Utilized :OpenCV 1.0
Reference : -
Etc. : -
 
 
 



This program is for detecting 4 corners of rects(3 rect).
The detection process is shown below.

1. Candidate corner detection using cvGoodFeaturesToTrack function.
2. Blob Coloring - Find 3 biggest blobs
3. Angle inspection tracking outline of blob. - using cvConvexHull2 function.
    Corner's angle would be big than other angles. so we select 4 corners.

<Source Code>
---------------------------------------------------------------------


λ‹€μŒκ³Ό 같은 κ³Όμ •μœΌλ‘œ μ‚¬κ°ν˜• μΊ˜λ¦¬λΈŒλ ˆμ΄μ…˜ νƒ€μΌ“μ˜ λͺ¨μ„œλ¦¬ 4ꡰ데λ₯Ό μ°ΎλŠ”λ‹€.

μΊ˜λ¦¬λΈŒλ ˆμ΄μ…˜ νƒ€μΌ“μ˜ μ½”λ„ˆ lefttop, righttop, rightbottom, leftbottom을 κ²€μΆœν•œλ‹€.

cvGoodFeaturesToTrack둜 μ½”λ„ˆ κ²€μΆœ
CBlobResult둜 Blob Coloringν•˜μ—¬ κ°€μž₯ 큰 덩어리 3개λ₯Ό 찾음 (μ‚¬κ°ν˜• 3개)
각 Blob에 λŒ€ν•΄ cvConvexHull2둜 μ™Έκ³½ 점 κ²€μΆœ
외곽점을 λ”°λΌκ°€λ©΄μ„œ 점 간에 각을 μ €μž₯
점 κ°„μ˜ 각도 쀑 κ°€μž₯ 각이 큰 4점을 μ„ νƒν•˜μ—¬ λͺ¨μ„œλ¦¬λ‘œ νŒλ‹¨ν•¨
νŒλ‹¨λœ 4μ μ—μ„œ μ½”λ„ˆμ κ³Ό κ°€μž₯ κ°€κΉŒμš΄ 4점을 선택함
μ΄λ ‡κ²Œ ν•œ μ‚¬κ°ν˜•μ— λŒ€ν•œ λͺ¨μ„œλ¦¬ 점이 선택됨

κ²°κ³ΌλŠ” μ„Έκ°œμ˜ μ‚¬κ°ν˜•μ— λŒ€ν•œ
Left Top, Right Top, Right Bottom, Left Bottom 의 이미지 μ’Œν‘œλ₯Ό μ•Œλ €μ€Œ
λ”°λΌμ„œ 카메라 μΊ˜λ¦¬λΈŒλ ˆμ΄μ…˜μ„ μœ„ν•œ μ›”λ“œ μ’Œν‘œ - 이미지 μ’Œν‘œ 값을 μžλ™μœΌλ‘œ μΆ”μΆœ κ°€λŠ₯함
 <Source Code>


10/06/2011

10th unmanned vehicle contest. The sponsor is Hyundai-Kia motors(Korea)

In 2010, I entered 10th unmanned vehicle contest.
The competition was sponsored by by Hyundai-Kia Motors.
In the our team, my part was software.
I had to solve many problems.
For example; Obstacle Detection and avoidance, mapping, path planing, Localization...
During prepare the competition, I programed nearly 30,000 lines. ^^
My team didn't acomplish the win. But our vehicle have finished all course as unmanned.
And I did my best. so I do not regret it.

OBS have broadcasted this competition.

This movie captured while unmaned vehicle driving.


This is architecture of software.

We have used many sensors and equipments.