We attached an ultrasonic sensor to the front of Tamiya so that it can detect how far away obstacles are. We later realized that we'd have to transfer this circuit to a breadboard in order to better attach other items to the robot.
The program allows the robot to move forward until it is less than 10 inches away from an obstacle to which it stops backs up and rotates to another direction. It then proceeds to move forward and navigate throughout the building or to find the remaining survivors in a disaster. We only needed to swap the sign of one of the motors when backing up so it would actually turn instead of staying in the same direction. Also we changed the max distance before chaning direction.