라즈베리파이 초음파 거리 센서 ULTRASONIC 코드

라즈베리파이 초음파 거리센서 ULTRASONIC 1

#include <stdio.h>
#include <wiringPi.h>

const int pinEcho = 1;
const int pinTrigger = 0;

int main(void)
{
	wiringPiSetupGpio();

	pinMode(pinEcho, INPUT);
	pinMode(pinTrigger, OUTPUT);

	digitalWrite(pinTrigger, LOW);
	delay(30);

	while(1)
	{
		digitalWrite(pinTrigger, HIGH);
		delayMicroseconds(20);
		digitalWrite(pinTrigger, LOW);

		while(digitalRead(pinEcho)==LOW);
		long startTime = micros();

		while(digitalRead(pinEcho)==HIGH);
		long endTime = micros()-startTime;

		int distance = endTime / 58;

		printf("Distance:%d\n",distance);
		delay(1000);
	}
	return 0;
}

 

라즈베리파이 초음파 거리센서 ULTRASONIC 2

#include <stdio.h>
#include <wiringPi.h>

const int pinEcho = 1;
const int pinTrigger = 0;

const int pinLed = 21;

int main(void)
{
	wiringPiSetupGpio();

	pinMode(pinEcho, INPUT);
	pinMode(pinTrigger, OUTPUT);
	pinMode(pinLed, OUTPUT);

	digitalWrite(pinTrigger, LOW);
	delay(30);
	while(1)
	{
		digitalWrite(pinTrigger, HIGH);
		delayMicroseconds(20);
		digitalWrite(pinTrigger, LOW);

		while(digitalRead(pinEcho) ==LOW);


		long startTime = micros();

		while(digitalRead(pinEcho)== HIGH);
		long endTime = micros() - startTime;

		int distance = endTime/58;
		if(distance <10)
		{
			digitalWrite(pinLed, HIGH);
		}
		else
		{
			digitalWrite(pinLed, LOW);
		}
		delay(1000);
		}
		return 0;
}