comparison include/VirtualClock.h @ 149:134bff10e561 ClockSync

Added simple one-variable one-measurement Kalman filter, Pid controller(which output is not used). Virtual clock is now much more precise and reactive for period. Still it is lagging behind a bit on the overall offset.

 #define VIRTUAL_CLOCK_H_INCLUDED
 
 #include "math.h"
 #include "stats.hpp"
 #include "Clock.h"
+#include "IirFilter.h"
+#include "Kalman.h"
 #ifdef USE_JUCE
 #else
 #include <BeagleRT.h>
 #endif /* USE_JUCE */
 
 class VirtualClock{
 private:
 	myClock_t startTime;
 	myClock_t startTimeOffset;
-	myClock_t lastSync;
+	myClock_t lastSyncTime;
+//	myClock_t lastSyncEstimatedTime;
+	double lastSyncEstimatedTime;
 	bool firstRun;
 	double elapsedPeriods;
 	double elapsedPeriodsOffset;
+	double blockPeriod;
 	double period;
 	MovingAverage<double> movingAverage;
+	IirFilter iir;
+	KalmanOne kalman;
 public:
-	void init();
+	void init(float initialValueUs);
 	VirtualClock();
 /**
 	Call this method at regular intervals to sync che virtual clock
 */
 	void sync();