67 lines
1.7 KiB
C++
67 lines
1.7 KiB
C++
/*
|
|
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;
|
|
}
|