The Tamiya Robot

The Tamiya Robot is one of the 3 robots used in this project. Its purpose is to track down people that may be lost in the building. It's programmed by Arduino and has touch sensors and a databot that can sense humans by an infrared thermometer. 

The photo and the video of the double gear motor.

Final Built Tamiya

Final Video

The Code

#pragma config(Sensor, port2,  distanceMM,     sensorVexIQ_Distance)

#pragma config(Sensor, port3,  colorDetector,  sensorVexIQ_ColorHue)

#pragma config(Sensor, port4,  gyroSensor,     sensorVexIQ_Gyro)

#pragma config(Sensor, port5,  touchLED,       sensorVexIQ_LED)

#pragma config(Sensor, port8,  bumpSwitchLeft, sensorVexIQ_Touch)

#pragma config(Sensor, port9,  bumpSwitchRight, sensorVexIQ_Touch)

#pragma config(Motor,  motor1,          leftMotor,     tmotorVexIQ, PIDControl, driveLeft, encoder)

#pragma config(Motor,  motor6,          rightMotor,    tmotorVexIQ, PIDControl, driveRight, encoder)