initial version
This commit is contained in:
66
sensors/StepSensor.h
Normal file
66
sensors/StepSensor.h
Normal file
@@ -0,0 +1,66 @@
|
||||
#ifndef STEPSENSOR_H
|
||||
#define STEPSENSOR_H
|
||||
|
||||
|
||||
#include "../misc/fixc11.h"
|
||||
#include "AccelerometerSensor.h"
|
||||
#include "Sensor.h"
|
||||
|
||||
struct StepData {
|
||||
;
|
||||
};
|
||||
|
||||
class StepSensor : public Sensor<StepData>, public SensorListener<AccelerometerData> {
|
||||
|
||||
private:
|
||||
|
||||
AccelerometerSensor& acc;
|
||||
|
||||
public:
|
||||
|
||||
/** hidden ctor. use singleton */
|
||||
StepSensor(AccelerometerSensor& acc) : acc(acc) {
|
||||
;
|
||||
}
|
||||
|
||||
void start() override {
|
||||
acc.addListener(this);
|
||||
acc.start();
|
||||
}
|
||||
|
||||
void stop() override {
|
||||
throw "todo";
|
||||
}
|
||||
|
||||
virtual void onSensorData(const AccelerometerData& data) override {
|
||||
parse(data);
|
||||
}
|
||||
|
||||
|
||||
protected:
|
||||
|
||||
const float threshold = 11.0;
|
||||
const int blockTime = 25;
|
||||
int block = 0;
|
||||
|
||||
void parse(const AccelerometerData& data) {
|
||||
|
||||
const float x = data.x;
|
||||
const float y = data.y;
|
||||
const float z = data.z;
|
||||
|
||||
const float mag = std::sqrt( (x*x) + (y*y) + (z*z) );
|
||||
|
||||
if (block > 0) {
|
||||
--block;
|
||||
} else if (mag > threshold) {
|
||||
informListeners(StepData());
|
||||
block = blockTime;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
};
|
||||
|
||||
|
||||
#endif // STEPSENSOR_H
|
||||
Reference in New Issue
Block a user