Here is the my robot code.
You can find this project at http://www.instructables.com/id/How-to-make-a-cool-robot-from-a-RC-car/
if you have any question, let me know here.