Skip to content

Instantly share code, notes, and snippets.

@sumansanyukta
Created November 14, 2020 13:17
Show Gist options
  • Save sumansanyukta/16941c80310efc36a2fdf6cf1c211aa9 to your computer and use it in GitHub Desktop.
Save sumansanyukta/16941c80310efc36a2fdf6cf1c211aa9 to your computer and use it in GitHub Desktop.
Arduino code for Radar System
#include<Servo.h>
const int TriggerPin = 8;
const int EchoPin = 9;
const int motorSignalPin = 10;
const int startingAngle = 90;
const int minimumAngle = 6;
const int maximumAngle = 175;
const int rotationSpeed = 1;
Servo motor;
void setup(void)
{
pinMode(TriggerPin, OUTPUT);
pinMode(EchoPin, INPUT);
motor.attach(motorSignalPin);
Serial.begin(9600);
}
void loop(void)
{
static int motorAngle = startingAngle;
static int motorRotateAmount = rotationSpeed;
motor.write(motorAngle);
delay(10);
SerialOutput(motorAngle, CalculateDistance());
motorAngle += motorRotateAmount;
if(motorAngle <= minimumAngle || motorAngle >= maximumAngle) {
motorRotateAmount = -motorRotateAmount;
}}
int CalculateDistance(void)
{
digitalWrite(TriggerPin, HIGH);
delayMicroseconds(10);
digitalWrite(TriggerPin, LOW);
long duration = pulseIn(EchoPin, HIGH);
float distance = duration * 0.017F;
return int(distance);
}
void SerialOutput(const int angle, const int distance)
{
String angleString = String(angle);
String distanceString = String(distance);
Serial.println(angleString + "," + distanceString);
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment