It seems that you are doing something very similar to what we did last year. If you can get in contact with me either through AIM/AOL or e-mail I am willing to share our setup and programming code with you. Visit our website
www.raiderrobotix.org and see if our bot is similar to what you are thinking.
-Bharat