|Surveyor Robotics Journal|
Sun, 23 Nov 2008
Laser pointer ranging function added to SRV-1 firmware
We now have a laser_range() function which uses the laser pointers and onboard camera in combination to estimate distance to the nearest obstacle. The function is accessed by console with 'R' or 'r' commands, the C interpreter via "range()", or the Lisp interpreter with "(range)". The 'r' console command dumps lots of diagnostic data, in case you want to see what the laser_range() function is thinking.
Here is a sample program for the C interpreter using the range() function:
A version of code for the new Lisp interpreter looks like this:
(define (stop) (robot 5))
Note that while the Lisp version is longer, most of the code is creating some library functions such as stop, left, right ... that can easily be used later. A detailed discussion of the new firmware version is found here on the Surveyor Robotics Forum. Thu, 13 Nov 2008
Robot Lisp for Surveyor SRV-1/SVS
A new version of Lisp has been added to the latest test version of Surveyor SRV-1/SVS firmware, as discussed on the Surveyor Robotics Forum. The code is based on "Scheme In One Defun" (SIOD) by George J. Carrette.
Lisp can be run interactively or loaded with a program from the flash buffer. There is a rich set of built-in functions, based on the Scheme dialect - cons, car, cdr, set-car!, set-cdr!, +, -, *, /, <, >, =, eq?, eqv?, assq, read, print, eval, define, lambda, if, while, begin, set!, or, and, quote, oblist, copy-list, gc-status, pair?, symbol?, number?, quit, not, null?, reverse.
We have extended this with some SRV-1/SVS specific functions -
So the command
will move the robot forward, and
will stop it
You could define the commands -
(define fwd 8)
(define back 2)
(define stop 5)
(define left 4)
(define right 6)
Then the command
would have the same effect as
Here is a very simple program to control the robot from the keyboard, using the digits 8, 5, 2, 4, and 6 as defined above, and 0 to exit the program ...
(> (set! x (input)) 0)
This is just the beginning. It is very easy to extend the language, and the next step is to add some image processing functions to enable search for objects(colors), avoidance of colors, etc.
Sun, 02 Nov 2008
one more pass at color segmentation + edge detection
Code for transferring data between processors via SPI bus on the SVS (stereo vision system) is in place, so now we need to decide what data to transfer for the purpose of building basic depth maps. There is no question that we will eventually need to move toward more robust feature detectors such as SIFT or SURF, but we should be able to get useful results from the simple combination of an edge detector and basic color segmentation.
The previous robotics journal post showed an edge detector combined with a 16-color segmentation based on just 4 levels of U and 4 levels of V, but no Y component. Shown below is 16-color segmentation based on the 'vz1' filter with 4 levels of Y, 2 levels of U and 2 levels of V. Combined with the edge detector, this approach seems to provide better feature differentiation than the UV-only approach, so that is the approach we will use as a basis for correlating between left and right views, though it is easy enough to change to other segmentation schemes.
displayed using SRV1Test.java