Click here to Skip to main content
15,867,985 members
Articles / Programming Languages / C#

Computer Vision: Laser Range Finder

Rate me:
Please Sign up or sign in to vote.
4.92/5 (58 votes)
7 Jul 2010GPL35 min read 183.5K   15.8K   121   55
Finding the distance of an object using a laser pen and an ordinary web-cam !

pic1.jpg

Introduction

These days, there are many range finder devices which are used almost everywhere from robotics to country's defence system. All these devices work well, but there are portability and cost concerns for general purpose robotics applications. From my previous articles, I've been creating cool programs related to webcam and now I've come up with a laser-web cam range finder. It could tell how far an object is by just using a very cheap laser pen and an ordinary web cam.

How It Works

apparatus.1.0.jpg

First, we need to arrange the laser pen exactly below the web cam so that it's parallel to the optical axis of the camera's lens. Practically, it's not possible even a minor error would give a huge error at greater distances, but this technique works good at short distances (~2 meters). Let's see why we arranged it in this way, check out the ray diagram below:

laser-range-finder-1.gif

When the laser beam is projected at some surface, it makes a laser dot on it and then image of that laser dot is formed at focal plane of web cam. Assuming that angle of view of camera is parallel, then by applying laws of similar triangles, we get:

h' / h = f' / D
h': height of laser dot(image) from center(image height)
h: height of laser beam below camera(actual height)
f': focus of camera, distance of lens to focal plane
D: we want this distance(range) 
so D = (f' * h) / h' 

Since focus of the camera doesn't change much at small distances, laser is fixed and it's height won't change so everything is constant here except h'(image height). We get our relation that D is inversely proportional to h'.

We know that a pixel is a unit of measurement so we want to re-define h' then we could say that h' is directly proportional to number pixels of laser dot from center of image or mathematically:

h' = k * (pixels of laser dot from center) 

where k is some constant depends on type of web cam and computer used. Now our final equation to find distance has reduced to a simple equation below:

D = K / (pixels of laser dot from center)

To find constant K we could choose experimental approach. We use known values to calculate constant of proportionality. It's just needed once and I've included this option in my program. All you need is to hold a piece of paper at a known distance, let's say 10cm from webcam and simply press a button and the computer will calculate the constant of proportionality.

Image Processing

Before reading further, please take a look at my previous article for "how to include webcam within your C# application".

Now we know that distance is inversely proportional to pixels of laser dot from the center of image. But first of all, we need to extract the laser dot from image. Well it's fairly easy using a computer vision library called AForge. In my case, laser dot is a highly red blob, so it could be extracted using color filter:

C#
//making clone of frame received from webcam
Bitmap image = (Bitmap)eventArgs.Frame.Clone();

//creating instance of color filtering for detection of laser light
ColorFiltering colr_filter = new ColorFiltering();

//setting the color filter properties
colr_filter.Red.Min = color_data.RedDown;
colr_filter.Red.Max = color_data.RedUp;

colr_filter.Blue.Min = color_data.BlueDown;
colr_filter.Blue.Max = color_data.BlueUp;

colr_filter.Green.Min = color_data.GreenDown;
colr_filter.Green.Max = color_data.GreenUp;

//apply filter and storing filtered image in another bitmap
Bitmap gray_image = colr_filter.Apply(image);	

Note: These RedDown, RedUp, BlueDown, etc. are pre-defined values within range of 0-255. Consider the following color filter code:

C#
// create filter
ColorFiltering colorFilter = new ColorFiltering( );
// configure the filter
colorFilter.Red   = new IntRange( 0, 100 );
colorFilter.Green = new IntRange( 0, 200 );
colorFilter.Blue  = new IntRange( 150, 255 );
// apply the filter
Bitmap objectImage = colorFilter.Apply( image );

Image 4

And when this code is applied on the image above, the resultant would be:

Image 5

Similarly, once we isolate the laser dot, we convert image to 8bpp gray scale for using other filters.

C#
//filter to convert RGB image to 8bpp gray scale for image processing 
IFilter gray_filter = new GrayscaleBT709();
gray_image = gray_filter.Apply(gray_image);	

Further, we apply threshold filter to retain only bright objects such as laser dot.

C#
//thresholding a image
Threshold th_filter = new Threshold(color_data.threshold);
th_filter.ApplyInPlace(gray_image); 

Then we apply erosion filter to remove unwanted and small pixels and then finally apply dilation filter to make laser blob more prominent.

C#
//erosion filter to filter out small unwanted pixels 
Erosion3x3 err_filter = new Erosion3x3();
err_filter.ApplyInPlace(gray_image);
C#
//dilation filter
Dilatation3x3 dil_filter = new Dilatation3x3();
dil_filter.ApplyInPlace(gray_image);

I've included a color tune form where you could play around with filters and visually see how changing values of certain filters could change the original image. You may find this option in Filters>>Edit.

color_tune.JPG

Once we have a white blob on laser dot, we use blob counter class to detect its location and geometric center. See the code below:

C#
//initialize a blob counting object to count blobs in image
BlobCounter bc = new BlobCounter();
//arrange blobs by area
bc.ObjectsOrder = ObjectsOrder.Area;
bc.MinHeight = 15;
bc.MaxWidth = 15;

//process image for blobs
bc.ProcessImage(gray_image);
gray_image.Dispose(); 

To find the geometric center of the blob, we use the following code:

C#
//get all the blobs from image
Blob[] b = bc.GetObjectsInformation();

//finding center of gravity of blob detected(b[0] is biggest blob by area)
IntPoint center_blob = b[0].CenterOfGravity;

Once we have the location of laser dot, then we could easily calculate the number of pixels from center of image by simple code:

C#
Math.Abs((float)(previous_image.Height/2) - y_cord) 

where y_cord is y coordinate of laser dot.

Now we are left with one more thing that is constant of calibration, we find this value experimentally. We choose a surface which is at a known distance from the camera and then we flash laser. Computer detects that laser light, finds the pixels from center and multiplies it with known distance and we get a constant. I've included this feature in the program, you may find it in Tools>>calibrate.

That's it! We are done building our laser range finder.

_pic2.jpg

Using the Program

You may first need to adjust the color filter to detect the laser light. When you are adjusting the settings of filter, remember that the white region is considered as a blob and black is rejected. Also you need to calibrate, it's pretty simple just go to Tools>>Calibrate and after that, the program will instruct you accordingly.

You could also change the source code to detect the edges of moving object. Basically, edges mean sudden change of range and we could also build some kind of robots that would follow some object by detecting its edges. It may also be used in autonomous robotics. For now, have fun with it. If you like it or found any error or need to give any suggestion, then share it with me though comments.

Update

Just updated the program, I found that sometimes it's not able to detect laser dot or at least not with full precision. So I added a manual mode to define laser dot on its own. You can download it from the link at the top of this article.

References

This article is greatly based on work and article written by Todd Danko. Make sure you read his article.

License

This article, along with any associated source code and files, is licensed under The GNU General Public License (GPLv3)


Written By
Canada Canada
cat me.txt

Comments and Discussions

 
QuestionvideoOCX erroe Pin
Member 1154098621-May-15 2:28
Member 1154098621-May-15 2:28 
GeneralMy vote of 5 Pin
Amir Mohammad Nasrollahi11-Aug-13 20:14
professionalAmir Mohammad Nasrollahi11-Aug-13 20:14 
QuestionGood Job Pin
OmarGW12-Mar-13 12:59
OmarGW12-Mar-13 12:59 
GeneralMy vote of 5 Pin
haji124519-Jan-13 22:49
haji124519-Jan-13 22:49 
GeneralMy vote of 5 Pin
umair ehsan17-Dec-12 0:03
umair ehsan17-Dec-12 0:03 
GeneralMy vote of 5 Pin
Zaid Pirwani14-Dec-12 6:45
Zaid Pirwani14-Dec-12 6:45 
GeneralMy vote of 5 Pin
Shine Jayakumar13-Oct-12 10:24
Shine Jayakumar13-Oct-12 10:24 
Questioni need the coordinations for laser point (X,y) values?? Pin
esaaco27-Sep-12 3:09
esaaco27-Sep-12 3:09 
Questionproject Pin
gokul898331-Aug-12 4:07
gokul898331-Aug-12 4:07 
Questionexcellent work Pin
sario10016-Dec-11 20:58
sario10016-Dec-11 20:58 
QuestionSource for manual mode? Pin
Diagram8-Nov-11 4:58
Diagram8-Nov-11 4:58 
GeneralHow track more than one blob Pin
Member 792126814-May-11 12:58
Member 792126814-May-11 12:58 
GeneralRe: How track more than one blob Pin
shivamkalra14-May-11 14:29
shivamkalra14-May-11 14:29 
GeneralRe: How track more than one blob Pin
Member 792126814-May-11 23:42
Member 792126814-May-11 23:42 
GeneralMy vote of 3 Pin
GreenShoes16-Aug-10 17:48
GreenShoes16-Aug-10 17:48 
GeneralGood Pin
Yves12-Jul-10 14:07
Yves12-Jul-10 14:07 
GeneralMy vote of 3 Pin
Corey Fournier7-Jul-10 10:00
Corey Fournier7-Jul-10 10:00 
GeneralRe: My vote of 3 Pin
shivamkalra7-Jul-10 12:18
shivamkalra7-Jul-10 12:18 
GeneralRe: My vote of 3 Pin
Corey Fournier7-Jul-10 12:58
Corey Fournier7-Jul-10 12:58 
GeneralRe: My vote of 3 Pin
shivamkalra7-Jul-10 13:04
shivamkalra7-Jul-10 13:04 
GeneralRe: My vote of 3 Pin
Corey Fournier7-Jul-10 13:07
Corey Fournier7-Jul-10 13:07 
GeneralRe: My vote of 3 Pin
shivamkalra7-Jul-10 13:17
shivamkalra7-Jul-10 13:17 
http://www.freepatentsonline.com/D453301.html[^]

There you go, this guy holds the patent for it. Not me, not the guy in that article. I didn't copied anybody's algorithm, I used a open source libary for doing image processing. All I've used is FUNDAMENTAL idea behind any laser range finder in this world. If you search on hackaday you will find plenty of LRFs working on same basic principle. I saw code project but there was no article similar to it. So I wrote the article, and if you read Todd's article he used brightest pixel approach for detecting laser which is way different from what I've used here. If you think I did some mistake I'm sorry. That's all I can say.

S
GeneralRe: My vote of 3 Pin
Corey Fournier7-Jul-10 13:38
Corey Fournier7-Jul-10 13:38 
GeneralVery cool as always, Shivam Pin
Marcelo Ricardo de Oliveira6-Jul-10 7:15
mvaMarcelo Ricardo de Oliveira6-Jul-10 7:15 
GeneralRe: Very cool as always, Shivam Pin
shivamkalra6-Jul-10 7:22
shivamkalra6-Jul-10 7:22 

General General    News News    Suggestion Suggestion    Question Question    Bug Bug    Answer Answer    Joke Joke    Praise Praise    Rant Rant    Admin Admin   

Use Ctrl+Left/Right to switch messages, Ctrl+Up/Down to switch threads, Ctrl+Shift+Left/Right to switch pages.