Well, here go again...
[youtube]http://www.youtube.com/watch?v=EdIOPvfQh1Y[/youtube]
Now it goes some steps ahead and avoid obstacles. Only some minors structure changes
The software it's in the PC (c#) and send the messages by bluetooth to the CM-5 in Toss mode.