Radar and servo

1//sonar:gnd to gnd 
2//echo to pin 11
3//trig to pin 10
4//vcc to  5V
5//servo:black to gnd 
6//red to 5V
7//yellow to pin 12 
8// Includes  the Servo library
9#include <Servo.h>. 
10// Defines Tirg and Echo pins of the  Ultrasonic Sensor
11const int trigPin = 10;
12const int echoPin = 11;
13// Variables  for the duration and the distance
14long duration;
15int distance;
16Servo myServo;  // Creates a servo object for controlling the servo motor
17void setup() {
18  pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output
19  pinMode(echoPin,  INPUT); // Sets the echoPin as an Input
20  Serial.begin(9600);
21  myServo.attach(12);  // Defines on which pin is the servo motor attached
22}
23void loop() {
24  //  rotates the servo motor from 15 to 165 degrees
25  for(int i=15;i<=165;i++){  
26  myServo.write(i);
27  delay(30);
28  distance = calculateDistance();// Calls  a function for calculating the distance measured by the Ultrasonic sensor for each  degree
29  
30  Serial.print(i); // Sends the current degree into the Serial Port
31  Serial.print(","); // Sends addition character right next to the previous value  needed later in the Processing IDE for indexing
32  Serial.print(distance); //  Sends the distance value into the Serial Port
33  Serial.print("."); // Sends  addition character right next to the previous value needed later in the Processing  IDE for indexing
34  }
35  // Repeats the previous lines from 165 to 15 degrees
36  for(int i=165;i>15;i--){  
37  myServo.write(i);
38  delay(30);
39  distance  = calculateDistance();
40  Serial.print(i);
41  Serial.print(",");
42  Serial.print(distance);
43  Serial.print(".");
44  }
45}
46// Function for calculating the distance measured  by the Ultrasonic sensor
47int calculateDistance(){ 
48  
49  digitalWrite(trigPin,  LOW); 
50  delayMicroseconds(2);
51  // Sets the trigPin on HIGH state for 10  micro seconds
52  digitalWrite(trigPin, HIGH); 
53  delayMicroseconds(10);
54  digitalWrite(trigPin, LOW);
55  duration = pulseIn(echoPin, HIGH); // Reads the  echoPin, returns the sound wave travel time in microseconds
56  distance= duration*0.034/2;
57  return distance;
58}
59

1import processing.serial.*; // imports library for serial communication
2import  java.awt.event.KeyEvent; // imports library for reading the data from the serial  port
3import java.io.IOException;
4Serial myPort; // defines Object Serial
5//  defubes variables
6String angle="";
7String distance="";
8String data="";
9String  noObject;
10float pixsDistance;
11int iAngle, iDistance;
12int index1=0;
13int  index2=0;
14PFont orcFont;
15void setup() {
16  
17 size (1200, 700); // ***CHANGE  THIS TO YOUR SCREEN RESOLUTION***
18 smooth();
19 myPort = new Serial(this,"COM3",  9600); // starts the serial communication
20 myPort.bufferUntil('.'); // reads  the data from the serial port up to the character '.'. So actually it reads this:  angle,distance.
21}
22void draw() {
23  
24  fill(98,245,31);
25  // simulating  motion blur and slow fade of the moving line
26  noStroke();
27  fill(0,4); 
28  rect(0, 0, width, height-height*0.065); 
29  
30  fill(98,245,31); // green  color
31  // calls the functions for drawing the radar
32  drawRadar(); 
33  drawLine();
34  drawObject();
35  drawText();
36}
37void serialEvent (Serial myPort) { // starts  reading data from the Serial Port
38  // reads the data from the Serial Port up  to the character '.' and puts it into the String variable "data".
39  data =  myPort.readStringUntil('.');
40  data = data.substring(0,data.length()-1);
41  
42  index1 = data.indexOf(","); // find the character ',' and puts it into  the variable "index1"
43  angle= data.substring(0, index1); // read the data  from position "0" to position of the variable index1 or thats the value of the  angle the Arduino Board sent into the Serial Port
44  distance= data.substring(index1+1,  data.length()); // read the data from position "index1" to the end of the data  pr thats the value of the distance
45  
46  // converts the String variables into  Integer
47  iAngle = int(angle);
48  iDistance = int(distance);
49}
50void drawRadar()  {
51  pushMatrix();
52  translate(width/2,height-height*0.074); // moves the starting  coordinats to new location
53  noFill();
54  strokeWeight(2);
55  stroke(98,245,31);
56  // draws the arc lines
57  arc(0,0,(width-width*0.0625),(width-width*0.0625),PI,TWO_PI);
58  arc(0,0,(width-width*0.27),(width-width*0.27),PI,TWO_PI);
59  arc(0,0,(width-width*0.479),(width-width*0.479),PI,TWO_PI);
60  arc(0,0,(width-width*0.687),(width-width*0.687),PI,TWO_PI);
61  // draws the  angle lines
62  line(-width/2,0,width/2,0);
63  line(0,0,(-width/2)*cos(radians(30)),(-width/2)*sin(radians(30)));
64  line(0,0,(-width/2)*cos(radians(60)),(-width/2)*sin(radians(60)));
65  line(0,0,(-width/2)*cos(radians(90)),(-width/2)*sin(radians(90)));
66  line(0,0,(-width/2)*cos(radians(120)),(-width/2)*sin(radians(120)));
67  line(0,0,(-width/2)*cos(radians(150)),(-width/2)*sin(radians(150)));
68  line((-width/2)*cos(radians(30)),0,width/2,0);
69  popMatrix();
70}
71void  drawObject() {
72  pushMatrix();
73  translate(width/2,height-height*0.074); //  moves the starting coordinats to new location
74  strokeWeight(9);
75  stroke(255,10,10);  // red color
76  pixsDistance = iDistance*((height-height*0.1666)*0.025); // covers  the distance from the sensor from cm to pixels
77  // limiting the range to 40  cms
78  if(iDistance<40){
79    // draws the object according to the angle and  the distance
80  line(pixsDistance*cos(radians(iAngle)),-pixsDistance*sin(radians(iAngle)),(width-width*0.505)*cos(radians(iAngle)),-(width-width*0.505)*sin(radians(iAngle)));
81  }
82  popMatrix();
83}
84void drawLine() {
85  pushMatrix();
86  strokeWeight(9);
87  stroke(30,250,60);
88  translate(width/2,height-height*0.074); // moves the starting  coordinats to new location
89  line(0,0,(height-height*0.12)*cos(radians(iAngle)),-(height-height*0.12)*sin(radians(iAngle)));  // draws the line according to the angle
90  popMatrix();
91}
92void drawText()  { // draws the texts on the screen
93  
94  pushMatrix();
95  if(iDistance>40)  {
96  noObject = "Out of Range";
97  }
98  else {
99  noObject = "In Range";
100  }
101  fill(0,0,0);
102  noStroke();
103  rect(0, height-height*0.0648, width,  height);
104  fill(98,245,31);
105  textSize(25);
106  
107  text("10cm",width-width*0.3854,height-height*0.0833);
108  text("20cm",width-width*0.281,height-height*0.0833);
109  text("30cm",width-width*0.177,height-height*0.0833);
110  text("40cm",width-width*0.0729,height-height*0.0833);
111  textSize(40);
112  text("Arohansenroy ", width-width*0.875, height-height*0.0277);
113  text("Angle:  " + iAngle +" °", width-width*0.48, height-height*0.0277);
114  text("Distance:  ", width-width*0.26, height-height*0.0277);
115  if(iDistance<40) {
116  text("        " + iDistance +" cm", width-width*0.225, height-height*0.0277);
117  }
118  textSize(25);
119  fill(98,245,60);
120  translate((width-width*0.4994)+width/2*cos(radians(30)),(height-height*0.0907)-width/2*sin(radians(30)));
121  rotate(-radians(-60));
122  text("30°",0,0);
123  resetMatrix();
124  translate((width-width*0.503)+width/2*cos(radians(60)),(height-height*0.0888)-width/2*sin(radians(60)));
125  rotate(-radians(-30));
126  text("60°",0,0);
127  resetMatrix();
128  translate((width-width*0.507)+width/2*cos(radians(90)),(height-height*0.0833)-width/2*sin(radians(90)));
129  rotate(radians(0));
130  text("90°",0,0);
131  resetMatrix();
132  translate(width-width*0.513+width/2*cos(radians(120)),(height-height*0.07129)-width/2*sin(radians(120)));
133  rotate(radians(-30));
134  text("120°",0,0);
135  resetMatrix();
136  translate((width-width*0.5104)+width/2*cos(radians(150)),(height-height*0.0574)-width/2*sin(radians(150)));
137  rotate(radians(-60));
138  text("150°",0,0);
139  popMatrix(); 
140}

1//sonar:gnd to gnd 
2//echo to pin 11
3//trig to pin 10
4//vcc to
5  5V
6//servo:black to gnd 
7//red to 5V
8//yellow to pin 12 
9// Includes
10  the Servo library
11#include <Servo.h>. 
12// Defines Tirg and Echo pins of the
13  Ultrasonic Sensor
14const int trigPin = 10;
15const int echoPin = 11;
16// Variables
17  for the duration and the distance
18long duration;
19int distance;
20Servo myServo;
21  // Creates a servo object for controlling the servo motor
22void setup() {
23
24  pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output
25  pinMode(echoPin,
26  INPUT); // Sets the echoPin as an Input
27  Serial.begin(9600);
28  myServo.attach(12);
29  // Defines on which pin is the servo motor attached
30}
31void loop() {
32  //
33  rotates the servo motor from 15 to 165 degrees
34  for(int i=15;i<=165;i++){  
35
36  myServo.write(i);
37  delay(30);
38  distance = calculateDistance();// Calls
39  a function for calculating the distance measured by the Ultrasonic sensor for each
40  degree
41  
42  Serial.print(i); // Sends the current degree into the Serial Port
43
44  Serial.print(","); // Sends addition character right next to the previous value
45  needed later in the Processing IDE for indexing
46  Serial.print(distance); //
47  Sends the distance value into the Serial Port
48  Serial.print("."); // Sends
49  addition character right next to the previous value needed later in the Processing
50  IDE for indexing
51  }
52  // Repeats the previous lines from 165 to 15 degrees
53
54  for(int i=165;i>15;i--){  
55  myServo.write(i);
56  delay(30);
57  distance
58  = calculateDistance();
59  Serial.print(i);
60  Serial.print(",");
61  Serial.print(distance);
62
63  Serial.print(".");
64  }
65}
66// Function for calculating the distance measured
67  by the Ultrasonic sensor
68int calculateDistance(){ 
69  
70  digitalWrite(trigPin,
71  LOW); 
72  delayMicroseconds(2);
73  // Sets the trigPin on HIGH state for 10
74  micro seconds
75  digitalWrite(trigPin, HIGH); 
76  delayMicroseconds(10);
77
78  digitalWrite(trigPin, LOW);
79  duration = pulseIn(echoPin, HIGH); // Reads the
80  echoPin, returns the sound wave travel time in microseconds
81  distance= duration*0.034/2;
82
83  return distance;
84}
85