Arduino 超声波传感器类库 简易开发

SR04.h

#ifndef SRO4_H
#define SR04_H
#if defined(ARDUINO) && ARDUINO >= 100
	#include "Arduino.h"
#else
	#include "WProgram.h"
#endif
class SR04{
	public:
		SR04(int TrigPin,int EchoPin);
		float Get();
	private:
		int Trig_pin;
		int Echo_pin;
		float distance;		
};
#endif

SR04.cpp

#if ARDUINO >= 100
	#include "Arduino.h"
#else
	#include "WProgram.h"
#endif
#include "SR04.H"
SR04::SR04(int TP,int EP){
	pinMode(TP,OUTPUT);
	pinMode(EP,INPUT);
	Trig_pin = TP;
	Echo_pin = EP;
}
float SR04::Get(){
	digitalWrite(Trig_pin,LOW);
	delayMicroseconds(2);
	digitalWrite(Trig_pin,HIGH);
	delayMicroseconds(10);
	digitalWrite(Trig_pin,LOW);
	float distance = pulseIn(Echo_pin,HIGH)/58.00;
	return distance;
}

keywords.txt

SR04 KEYWORD1
Get KEYWORD2

你可能感兴趣的:(嵌入式开发)