Moved skip if _interrupt is hot

We used to skip the next sensor if the interrupt pin is still high.

Change it to not move to the next sensore if high

LICENSE.md

@@ -0,0 +1,21 @@
+The MIT License (MIT)
+
+Copyright (c) 2013,2015,2017 Alastair Young
+
+Permission is hereby granted, free of charge, to any person obtaining a copy
+of this software and associated documentation files (the "Software"), to deal
+in the Software without restriction, including without limitation the rights
+to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+copies of the Software, and to permit persons to whom the Software is
+furnished to do so, subject to the following conditions:
+
+The above copyright notice and this permission notice shall be included in all
+copies or substantial portions of the Software.
+
+THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+SOFTWARE.

src/SonarI2C.cpp

@@ -29,7 +29,6 @@ void SonarI2C::init() {
 // private member functions
 // send the trigger signal and attach the interrupt
 void SonarI2C::_send_ping() {
-  if (digitalRead(_interrupt) == inverse ? LOW : HIGH) return; // interrupt pin is active - skip
   _pulseBegin = 0; // cleared until we see it
   attachInterrupt(digitalPinToInterrupt(_interrupt), _startPulse, inverse ? FALLING : RISING); // NOR gate - pulse is inverted
   Wire.beginTransmission(_address);
@@ -118,6 +117,7 @@ void SonarI2C::begin(uint8_t interrupt) {
 // call from loop() every cycle
 void SonarI2C::doSonar() {
   if (!_currentSonar) return; // no sonars initiated
+  if (digitalRead(_interrupt) == inverse ? LOW : HIGH) return; // interrupt pin is active - skip
   if (_last_sonar_millis + _spacing < millis()) {
     // look for next enabled sonar
     SonarI2C *thisSonar = _currentSonar->_nextSonar;