Let's Make Robots!

WiiDAR - or ($40 LIDAR)

Works like LIDAR - uses a wiimote

 

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.

 

Comment viewing options

Select your preferred way to display the comments and click "Save settings" to activate your changes.

I've started a blog on researching serial connectivity here

Have you tested the wiidar outdoors? I am thinking of entering the http://www.rie2011.org/robotour/ competition and I am researching sensors, mostly for obstacle detection.

Didn't get the opportunity, before I fried the wii's regulator with too much power.  It was pretty robust indoors.  For a short range outdoor system it would probably work.  You could add more filtering for 650 nm if your going to use a cheap key chain laser.  You could also use a polarized filter for the laser, I thought this could add quality filtering - since all the light from any laser is polarized in the same way, just have to make sure the laser and filter are oriented in the same way.  Higher wattage IR Laser would probably extend the range considerably, but the added safety concerns might not be worth it.

I guess I should go buy a wiimote and test it myself...

I was meaning to get another one, and make an incredibly easy to build and powerful mapping robot.  It would basically be a wiimote with a motor controller.  You could drop it on the floor and it would map your whole house.

I had a computer talking to it using wireless calls to the LEDs as a form of 3 bit parallel port.  The idea being the computer would map everything and tell the little tiny bot where to go.  I think it has potential, but have been too busy with other stuff to get back to the project.  I fried it when I did not have 3.3V motor controller and overpowered it with 5V.

If you do get a wii controller, you might be interested in MRL's WiiDar service to connect to and visualize your Wii data.