|
- /*
- Ping.cpp - Library for using Ping))) Sensors with Arduino - Version 2
- Copyright (c) 2009 Caleb Zulawski. All right reserved.
-
- This library is free software; you can redistribute it and/or
- modify it under the terms of the GNU Lesser General Public
- License as published by the Free Software Foundation; either
- version 2.1 of the License, or (at your option) any later version.
-
- This library is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- Lesser General Public License for more details.
-
- You should have received a copy of the GNU Lesser General Public
- License along with this library; if not, write to the Free Software
- Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
- */
-
- #include "Arduino.h"
- #include "Ping.h"
-
- Ping::Ping(int pin)
- {
- pinMode(pin, OUTPUT);
- _pin = pin;
- _in = 0;
- _cm = 0;
- _duration = -1;
- }
- Ping::Ping(int pin, double in, double cm)
- {
- pinMode(pin, OUTPUT);
- _pin = pin;
- _in = in;
- _cm = cm;
- _duration = -1;
- }
-
- void Ping::fire()
- {
- pinMode(_pin, OUTPUT);
- digitalWrite(_pin, LOW);
- delayMicroseconds(2);
- digitalWrite(_pin, HIGH);
- delayMicroseconds(5);
- digitalWrite(_pin, LOW);
- pinMode(_pin, INPUT);
- _duration = pulseIn(_pin, HIGH);
-
- }
-
- int Ping::microseconds()
- {
- return _duration;
- }
-
- double Ping::inches()
- {
- if(_duration != -1){
- return _duration / (74+_in) / 2;
- }else{
- return -1;
- }
- }
-
- double Ping::centimeters()
- {
- if(_duration != -1){
- return _duration / (29+_cm) / 2;
- }else{
- return -1;
- }
- }
|