RADAR CON SENSOR ULTRASÓNICO-1.docx - UNIVERSIDAD DEL VALLE DE GUATEMALA CAMPUS ALTIPLANO Héctor Brian Hernández Chut� Carné 171254 Curso Robótica

RADAR CON SENSOR ULTRASÓNICO-1.docx - UNIVERSIDAD DEL...

This preview shows page 1 - 3 out of 8 pages.

UNIVERSIDAD DEL VALLE DE GUATEMALA CAMPUS ALTIPLANO Héctor Brian Hernández Chutá Carné: 171254 Curso: Robótica RADAR CON SENSOR ULTRASÓNICO Código en arduino // Includes the Servo library #include <Servo.h>. // Defines Tirg and Echo pins of the Ultrasonic Sensor const int trigPin = 10; const int echoPin = 11; // Variables for the duration and the distance long duration; int distance; Servo myServo; // Creates a servo object for controlling the servo motor void setup() { pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output pinMode(echoPin, INPUT); // Sets the echoPin as an Input Serial.begin(9600); myServo.attach(12); // Defines on which pin is the servo motor attached } void loop() { // rotates the servo motor from 15 to 165 degrees for(int i=15;i<=165;i++){ myServo.write(i); delay(30); distance = calculateDistance();// Calls a function for calculating the distance measured by the Ultrasonic sensor for each degree Serial.print(i); // Sends the current degree into the Serial Port
Image of page 1
Serial.print(","); // Sends addition character right next to the previous value needed later in the Processing IDE for indexing Serial.print(distance); // Sends the distance value into the Serial Port Serial.print("."); // Sends addition character right next to the previous value needed later in the Processing IDE for indexing } // Repeats the previous lines from 165 to 15 degrees for(int i=165;i>15;i--){ myServo.write(i); delay(30); distance = calculateDistance(); Serial.print(i); Serial.print(","); Serial.print(distance); Serial.print("."); } } // Function for calculating the distance measured by the Ultrasonic sensor int calculateDistance(){
Image of page 2
Image of page 3

  • Left Quote Icon

    Student Picture

  • Left Quote Icon

    Student Picture

  • Left Quote Icon

    Student Picture