initial commit

libraries/FirmataWithDeviceFeature/src-features/FirmataReporting.cpp

@@ -0,0 +1,66 @@
+/*
+  FirmataReporting.cpp - Firmata library
+  Copyright (C) 2006-2008 Hans-Christoph Steiner.  All rights reserved.
+  Copyright (C) 2010-2011 Paul Stoffregen.  All rights reserved.
+  Copyright (C) 2009 Shigeru Kobayashi.  All rights reserved.
+  Copyright (C) 2013 Norbert Truchsess. All rights reserved.
+  Copyright (C) 2009-2016 Jeff Hoefs.  All rights 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.
+
+  See file LICENSE.txt for further informations on licensing terms.
+*/
+
+#include <ConfigurableFirmata.h>
+#include "FirmataFeature.h"
+#include "FirmataReporting.h"
+
+void FirmataReporting::setSamplingInterval(int interval)
+{
+  samplingInterval = interval;
+}
+
+void FirmataReporting::handleCapability(byte pin)
+{
+
+}
+
+boolean FirmataReporting::handlePinMode(byte pin, int mode)
+{
+  return false;
+}
+
+boolean FirmataReporting::handleSysex(byte command, byte argc, byte* argv)
+{
+  if (command == SAMPLING_INTERVAL) {
+    if (argc > 1) {
+      samplingInterval = argv[0] + (argv[1] << 7);
+      if (samplingInterval < MINIMUM_SAMPLING_INTERVAL) {
+        samplingInterval = MINIMUM_SAMPLING_INTERVAL;
+      }
+      return true;
+    }
+  }
+  return false;
+}
+
+boolean FirmataReporting::elapsed()
+{
+  currentMillis = millis();
+  if (currentMillis - previousMillis > samplingInterval) {
+    previousMillis += samplingInterval;
+    if (currentMillis - previousMillis > samplingInterval)
+      previousMillis = currentMillis - samplingInterval;
+    return true;
+  }
+  return false;
+}
+
+void FirmataReporting::reset()
+{
+  previousMillis = millis();
+  samplingInterval = 19;
+}