Arduino+超音波模組+processing=雷達系統
發表於 : 2023年 4月 10日, 06:55
Arduino code
---------------------------------------------------------------------------------------
----------------------- 以下為 processing code ---------------------------
processing code
代碼: 選擇全部
#include <Servo.h>
const int trigPin = 10;
const int echoPin = 11;
long duration;//歷時
int distance;//距離
Servo myServo; //物件
void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
Serial.begin(9600);
myServo.attach(12);
}
void loop() {
for(int i=15;i<=165;i++){
myServo.write(i);
delay(30);
distance = calculateDistance();
Serial.print(i);
Serial.print(",");
Serial.print(distance);
Serial.print(".");
}
for(int i=165;i>15;i--){
myServo.write(i);
delay(30);
distance = calculateDistance();
Serial.print(i);
Serial.print(",");
Serial.print(distance);
Serial.print(".");
}
}
int calculateDistance(){
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance= duration*0.034/2;//計算距離,公式為:distance = duration * 0.034 / 2
return distance;
}
----------------------- 以下為 processing code ---------------------------
processing code
代碼: 選擇全部
// 這是 Processing 程式碼
// 從第 60 行到 199 行複製貼上程式碼
import processing.serial.*; // 匯入串列通訊的程式庫
import java.awt.event.KeyEvent; // 匯入處理按鍵事件的程式庫
import java.io.IOException; // 匯入處理輸入輸出異常的程式庫
Serial myPort; // 宣告一個串列物件 myPort
// 宣告變數
String angle="";
String distance="";
String data="";
String noObject;
float pixsDistance;
int iAngle, iDistance;
int index1=0;
int index2=0;
PFont orcFont;
void setup() {
size (1200, 700); // 設定畫布大小
smooth(); // 啟用圖形平滑處理
myPort = new Serial(this,"COM10", 9600); // 設定串列通訊物件 myPort,指定 COM10 連接埠和 9600 波特率
myPort.bufferUntil('.'); // 設定串列物件以 . 為緩衝區結束符號
}
void draw() {
fill(98,245,31); // 設定填充色
noStroke(); // 設定無邊框
fill(0,4); // 設定填充色
rect(0, 0, width, height-height*0.065); // 畫一個矩形,作為雷達的背景
fill(98,245,31); // 設定填充色
drawRadar(); // 畫雷達圖形
drawLine(); // 畫距離線條
drawObject(); // 畫探測物體
drawText(); // 畫文字
}
void serialEvent (Serial myPort) { // 宣告處理串列事件的函數
data = myPort.readStringUntil('.'); // 讀取串列數據
data = data.substring(0,data.length()-1); // 去掉字串最後一個字符
index1 = data.indexOf(","); // 找到逗號的位置
angle= data.substring(0, index1); // 取得角度值
distance= data.substring(index1+1, data.length()); // 取得距離值
// 將字串型態的變數轉換為整數型態
iAngle = int(angle);
iDistance = int(distance);
}
void drawRadar() {
pushMatrix(); // 儲存目前的繪圖矩陣狀態
translate(width/2,height-height0.074); // 移動繪圖原點到中心點
noFill(); // 不填充圖形
strokeWeight(2); // 設置線條寬度
stroke(98,245,31); // 設置線條顏色
// 繪製弧形線條
arc(0,0,(width-width0.0625),(width-width0.0625),PI,TWO_PI);
arc(0,0,(width-width0.27),(width-width0.27),PI,TWO_PI);
arc(0,0,(width-width0.479),(width-width0.479),PI,TWO_PI);
arc(0,0,(width-width0.687),(width-width*0.687),PI,TWO_PI);
// 繪製角度線條
line(-width/2,0,width/2,0);
line(0,0,(-width/2)*cos(radians(30)),(-width/2)*sin(radians(30)));
line(0,0,(-width/2)*cos(radians(60)),(-width/2)*sin(radians(60)));
line(0,0,(-width/2)*cos(radians(90)),(-width/2)*sin(radians(90)));
line(0,0,(-width/2)*cos(radians(120)),(-width/2)*sin(radians(120)));
line(0,0,(-width/2)*cos(radians(150)),(-width/2)*sin(radians(150)));
line((-width/2)*cos(radians(30)),0,width/2,0);
popMatrix(); // 恢復繪圖矩陣狀態
}
void drawObject() {
pushMatrix(); // 儲存目前的繪圖矩陣狀態
translate(width/2,height-height0.074); // 移動繪圖原點到中心點
strokeWeight(9); // 設置線條寬度
stroke(255,10,10); // 設置線條顏色為紅色
pixsDistance = iDistance((height-height0.1666)0.025); // 計算目標距離對應到畫面上的像素距離
// 限制目標距離在40公分以內
if(iDistance<40){
// 根據角度和距離繪製目標
line(pixsDistancecos(radians(iAngle)),-pixsDistancesin(radians(iAngle)),(width-width*0.505)cos(radians(iAngle)),-(width-width0.505)*sin(radians(iAngle)));
}
popMatrix(); // 恢復繪圖矩陣狀態
}
void drawLine() {
pushMatrix();
strokeWeight(9);
stroke(30,250,60);
translate(width/2,height-height*0.074);
line(0,0,(height-height*0.12)*cos(radians(iAngle)),-(height-height*0.12)*sin(radians(iAngle)));
popMatrix();
}
void drawText() {
pushMatrix();
if(iDistance>40) {
noObject = "Out of Range";
}
else {
noObject = "In Range";
}
fill(0,0,0);
noStroke();
rect(0, height-height*0.0648, width, height);
fill(98,245,31);
textSize(25);
text("10cm",width-width*0.3854,height-height*0.0833);
text("20cm",width-width*0.281,height-height*0.0833);
text("30cm",width-width*0.177,height-height*0.0833);
text("40cm",width-width*0.0729,height-height*0.0833);
textSize(40);
text("Zeno_Modiff", width-width*0.875, height-height*0.0277);
text("Angle: " + iAngle +" °", width-width*0.48, height-height*0.0277);
text("Distance: ", width-width*0.26, height-height*0.0277);
if(iDistance<40) {
text(" " + iDistance +" cm", width-width*0.225, height-height*0.0277);
}
textSize(25);
fill(98,245,60);
translate((width-width*0.4994)+width/2*cos(radians(30)),(height-height*0.0907)-width/2*sin(radians(30)));
rotate(-radians(-60));
text("30°",0,0);
resetMatrix();
translate((width-width*0.503)+width/2*cos(radians(60)),(height-height*0.0888)-width/2*sin(radians(60)));
rotate(-radians(-30));
text("60°",0,0);
resetMatrix();
translate((width-width*0.507)+width/2*cos(radians(90)),(height-height*0.0833)-width/2*sin(radians(90)));
rotate(radians(0));
text("90°",0,0);
resetMatrix();
translate(width-width*0.513+width/2*cos(radians(120)),(height-height*0.07129)-width/2*sin(radians(120)));
rotate(radians(-30));
text("120°",0,0);
resetMatrix();
translate((width-width*0.5104)+width/2*cos(radians(150)),(height-height*0.0574)-width/2*sin(radians(150)));
rotate(radians(-60));
text("150°",0,0);
popMatrix();
}