Rescuing Victims

IR Sensor's are on the side of our robots arm to detect victims , when it caught the victims , it should understand that the victim is dead or alive , as the alive victims are conductive , we covered our grippers in alumimium foil and connected one of them to data and the other one to GND this will act like a key.

To Separate our victims our separator and gripper moves.

And for finding the red and green evacuation zone we used three OpenMV cameras to detect them. when our robots two front microswitches hits , it would detect a wall or evacuation zone and we should separate them using its ultrasonic , if its distance was more than a certain amount it will detect the evacuation zone.

When it detected the evacuation zone now it should know that witch evacuation zone is that , red or green. For detecting them it raises its arm so it can detect the type of evacuation zone, because the OpenMV camera is under its arm.

Our robot holds the victims witch it shouldn't drop using its separator so it can rescue all of the victims successfully and it raises its box and drops the victims.

Comments

Obstacle

we recognize the obstacle with the distance meter (ultrasonic) or the microswitch that is in front of the robot, after the detection: If the robot detects the obstacle with the distance meter it will: 1-goes backward , 2-turns 90 degrees , 3-goes straight for a bit , 4-turns 45 degrees If the robot detects the obstacle with its microswitch's it will: 1- if the left microswitch hits the obstacle it will goes leftward until the distance meter sensor detects the obstacle. 2- if the right microswitch hits the obstacle it will goes rightward until the distance meter sensor detects the obstacle.

Line Following

We used some coefficients in this function that we get from putting our sensors on the green color, using this coefficients in our program, robot will follow the line perfectly , this coefficients are different in our sensors. We put our center IR Sensor in third priority because if we wrote it in main priority it wouldn't be able to do next conditions. We made a function named "Time No Act" it works when robot follows a line and it 45 angel goes below degrees, in this function robot only goes forward until the tiles with under 45 degrees.

Green Detection

we made easier to detect the hardest colors with some coefficient, this coefficient are divide green by red , green by blue and blue by red. With placing two color detection sensor on our Sensor Board and seeing the numbers of this coefficients and also setting them on our robot menu using our TFT Display we can make sure of our robots green detection. As we have two states for the robots rotation on the green color 90 and 45 degrees we should separate this two states. when the robot reaches intersection it goes forward a bit , after that if the facing tile is white , robot will rotate 45 degrees and follow the line. If the facing tile is a black line robot will rotate 90 degrees and follow the line.

Pishnam Programming