My code for my robot projet is:
Please read #7 below and put your code in code tags:
http://forum.arduino.cc/index.php/topic,148850.0.html