First RADAR then LIDAR now WiiDAR !

WiiDAR is Light Detection And Ranging using a Wii Remote.

LIDAR units although great sensors tend to be expensive. The Hokuyo URG-04LX-UG01 is $1,175.00 USD.

Wii Remote has an infrared camera on the front of it.  The hardware can track up to 4 infrared spots at one time.  The information regarding these spots can be sent via bluetooth to another bluetooth receiver.  It turns out that the IR camera can also pick up the reflected light of a key chain laser if a filter is removed from the front of the WiiMote.  

In the following post I'll describe how to make a rough form of LIDAR using not much more than $40 worth of supplies.

Parts

  • WiiRemote - $38
  • 5 mW 650 nm Key Chain Laser - $2.79 - It's quite possible that an IR laser would have much better range - DVDs have IR laser diodes, but it would require focusing to an appropriate range.  Most laser IR laser pens are expensive and more hazardous since people can not actually see the beam.
  • Computer (if you reading this I assume you have one)
  • Blue Tooth Dongle $2 to $40.  This seems to vary wildly in price.  I got mine (RF-FLBTAD) for $30 at Best Buy.  I'm not including it in the price of the WiiDAR since it will not be damaged or modded in any way, and can be used for other things like headphones.
  • Servo - I used a servo, other configurations are possible. For example, motor and encoder, or stepper motor.
  • A Bunch O' Software - I used MyRobotLab wiiuse and wiiuseJ - all free, yet will require work (I said "free" not "easy")

Step 1

Glue  pen laser and wii to the top of the servo.  I mounted my laser at about 4" away and with a 65 degree tilt towards the wii camera.  The 65 degrees is almost arbitrary.  I was interested in ranges of about 2 to ~40 inches.  With that angle the horizontal disparity of the laser point is at a maximum within the range of ~40".  This would be the preferred mounting orientation, but the center of gravity would adversely affect the servo.  I had to mount the camera further forward.  Soon, I will be desoldering the camera, and mounting it on the axis of the servo.

preferred mounting

actual

Step 2
Remove the WiiMote IR filter with these instructions.  At this point, you just need to take the IR filter out.

Step 3
Mount the WiiMote and Laser/Servo to a surface where you can start to do some tests.  A little hot glue might be in order.  Calibrate using a tape measure and some trig.

Step 4
Download MyRobotLab and unzip it.
Download thirdParty.zip and unzip the contents into the myrobotlab/lib directory

Start  myrobotlab.bat or myrobotlab.sh depending on what operating system you are using.  This starts the Invoker Service, which will allow you to add the Wii Service and WiiDAR service.  Unfortunately at this time (2011-2-10) there is no way currently to connect messaging through the GUI - it needs to be done by modifying source code.  I plan to overhaul the GUI Map to allow such message routing manipulation.  You are welcome to contact me for the source if you care to change it yourself.

Future Plans

All this was done without "modding" any parts asides from removing the wii IR filter- Just gluing some pieces together.  To develop it further I will need to desolder the camera and solder lines onto the LEDs in addition I will need to create an extension interface (where the nunchuck plugs in)

Service Map for WiiDAR

WiiDAR sends commands to the Servo and receives IR data from the Wii Service.  It computes the data then sends it to the GUI.  I have been experimenting with taking those images and sending them to the OpenCV service - to extract linear information (e.g. HoughLines)

 

 

 

 

Other Ideas

  • Begin working on WiiBOT the mobile platform robot utilizing the Wiimote + Arduino and WiiDAR
  • Desolder Wii camera so it can easily be mounted in the center axis of a servo
  • A mobile chassi will be controlled by the PC via bluetooth and the WiiMote.  It is AMAZING all the sensors and controls which can be used/hacked on the WiiMote.   Commands from the computer will direct the mobile platform to turn left/right/stop/explore a new area, etc.  
    Data will be exchanged this way:  Computer -> bluetooth -> wiimote -> LED -> Arduino -> motor, servo's etc.  
    Other direction: Sensors -> Arduino -> I2C -> Extension Port -> bluetooth -> Computer
  • Another step is to get SLAM working - This will allow the robot to create and update a map and navigate within it.
  • Tilt the WiiDAR for 3D mapping.
  • Try encoder with twice the resolution
  • Mechanical step down of servo - so each position = .5 degrees
  • Double or quadruple the number of lasers - keep pulsing them to avoid cross-overproblems
  • Fix the warping do to wii camera not being mounted on servo axis

 

Development and Previous Failures

 

 

 

 

Here is the Sketchup I did which helped me figure out the process.  There is a 1024 X 768 virtual screen on the IR camera in the diagram.  In this sketch there are 3 blocks that are ranged.  The laser is at a constant 64.5 degree angle. If the camera finds the reflected spot @ 58 pixels - this corresponds to an angular measurement.  

So for any reflected dot you have the 

  • angle of the laser 64.5
  • distance between the laser & camera 4"
  • and angle of the ranged dot relative to the camera - initially provided in pixels

This is the old Angle-Side-Angle triangle.  Solve it, and you will have the distance from the camera to a block.

 

 

 

 

Here is the function (in Java) to solve for distance.

 

 

 

 


  public double computeDepth(IRData ir) {
    // int pixels = 1023 - 473;
    int pixels = 1023 - ir.event.getAx();

    // range point
    double A; // laser static angle
    double B; // camera angle
    double C; // point's angle

    double a; // this is what I want, it "should be" distance from the wii camera
    // double b; // distance from the laser - don't care
    double c = 4// distance from camera to laser

    A = Math.toRadians(61.5);

    if (pixels > width / 2) { // obtuse triangle
      B = Math.toRadians(90 ((pixels - width / 2/ pixelsPerDegree))
    else {
      // acute triangle
      B = Math.toRadians(90 ((width / - pixels/ pixelsPerDegree))
    }
    C = Math.toRadians(180(B + A);

    // Law of Sines, like stop sines
    a = (c * Math.sin(A)) / Math.sin(C);

    return a;
  }

 

 


MK.1 
Pros - simple mechanical design, just mount the laser pointer on a servo
Cons - math is more complex, but worse is the fact that as the angle sweeps the resolution varies, had problems syncing servo with IR event

 


MK.2 
Pros - encoder could possibly have higher resolution if I used both channels
Cons - math is more complex, but worse is the fact that as the angle sweeps the resolution varies,
used only 1 channel which had 300 slots (so this was worse resolution than a servo which is about 1 degree)
In this design and previous the "ends" of the sweep became highly distorted due to change of momentum of the servo
and lag time between telling the servo to move and receiving an IR signal.
 

 

 
MK.3 
Pros - encoder could possibly have higher resolution if I used both channels - movement is smooth
Cons - only 20% of a revolution is used - (100% would be used if the wii camera was also mounted on the motor - with 360 degree view - similar to the Neato XV-11)  Motor spun too fast, even with 5V and low PWM data from encoder was overwhelming.  Taped 75% of the encoder up to make it less "chatty"  Potentially, this could be a good design
 
Current Design
MK.4
Pros - Camera mounted directly to the laser - both mounted to servo, problems with jitters at the end of sweeps are eliminated.  Math is simpler.  Resolution is constant instead of always changing. 
Cons - Camera not mounted in center axis of servo due to balancing problem.  This can be solved by desoldering the camera and mounting the camera on an I2C umbilical cord with the wii body behind.
 
Previous Software Failures
 
 
Left screen is data directly from the wii camera, right screen is beginning of interpolation.  The XY coordinate seemed
to be a bit "off".  Turns out the camera is really mounted upside down DUH, right is left and left is right, up is down, etc.
The line segments represent horizontal disparity between samples, this is the first step to determine range.
 
 

Can see some of the bad distortions at the end of this sweep ... it is supposed to be a "straight" wall.

carloshack

12 years 11 months ago

Hi!

As i wrote you before,in this moment i'm working in an anphibious robot with a mapping system, searching in internet i saw your 40$ lidar system, i'm implementing it but i have some problems with the maths, so i wanna ask you about the function "pixelsperdegree" that you used in your source code to determine the distance between the wiidar and the object. i was killing my brain trying to find hat it means any help that you could bring will be very appreciaated.



thanks in advance.

cheers,



Carlos

Welcome !

pixelsPerDegree is a  variable which can change between different cameras.  

I discovered the Wii IR Camera has a value of 24 pixels per degree.  You can determine this by dividing the field of view by the horizontal resolution.  But I'm pretty sure all wii cameras are about the same.  This is how it is in the code.

double pixelsPerDegree = 24;

 

Hope this helps, let me know if this makes sense to you, and good luck on your project !

mr_electric

10 years 3 months ago

If I were to use an IR laser, would I need to remove the filter?

thanks, mr_e

GroG

10 years 3 months ago

In reply to by mr_electric

Which filter?
Without knowing the details of the parts you have or the parts you plan to get, its difficult giving a good guess.

With an IR laser I would think it would bwork better with the camera filter left in place, as the way Wii is originally designed it uses IR, it just so hapens the red pen laser is "close enough"  in the spectrum to work.