comparison bayesianArraySrc/BayesianArrayStructure.cpp @ 3:5e188c0035b6

checking the offsets of the arrays

 	
 	lastEventTime = 0;//ofGetElapsedTimeMillis();
 
 	tmpBestEstimate = 0;
 	crossUpdateTimeThreshold = 60;
-	priorWidth = 50;
+	priorWidth = 20;
 	
 }
 
 BayesianArrayStructure::BayesianArrayStructure(int length){
 	printf("BAYESIAN STURCTURE CREATED LENGTH: %i\n", length);

 void BayesianArrayStructure::setStartPlaying(){
 	
 	lastEventTime = 0;
 	bestEstimate = 0;
 	lastBestEstimateUpdateTime = 0;
+	
 	if (*realTimeMode)
 		lastBestEstimateUpdateTime = ofGetElapsedTimeMillis();
 	//cannot just be zero - offline bug
 	//printf("start playing - best estimate %f\n", lastBestEstimateUpdateTime);
 	

 	
 	posterior.offset = -1000;
 	setNewDistributionOffsets(0);
 	
 	int zeroIndex = posterior.getRealTermsAsIndex(0);
-	
-	posterior.addGaussianShape(zeroIndex, 500, 1);
-	//	posterior.addToIndex(0, 1);
+	printf("ZERO INDEX %i\n", zeroIndex);
+	
+	posterior.addGaussianShapeFromRealTime(0, 500, 1);//one way to add at x msec
+	posterior.addGaussianShape(posterior.getRealTermsAsIndex(10), 50, 1);//alternative way
+	
+	//posterior.addToIndex(0, 1);
 	likelihood.addConstant(1);
 	
 	updateCounter = 0;
 	
 
 	printf("bayes reset arrays - best estimate %f\n", lastBestEstimateUpdateTime);
 	
 	setSpeedPrior(speedPriorValue);
+	relativeSpeedPosterior.copyFromDynamicVector(relativeSpeedPrior);
+	
 }
 
 
 void BayesianArrayStructure::zeroArrays(){
 	prior.zero();

 	//lastBestEstimateUpdateTime = ofGetElapsedTimeMillis();
 }
 	
 void BayesianArrayStructure::updateBestEstimate(const double& timeDifference){
 //	double timeDiff = ofGetElapsedTimeMillis() - lastEventTime;//
+	double tmp = bestEstimate;
+	printf("post offest %i\n", posterior.offset);
 	
 	double timeDiff = timeDifference;
 	
 	//Using timedifferencfe here will make it go wrong. Is time since beginning of playing
 	

 		speedEstimateIndex = relativeSpeedPosterior.MAPestimate;
 	
 	speedEstimate = relativeSpeedPosterior.getIndexInRealTerms(speedEstimateIndex);
 	bestEstimate = posterior.getIndexInRealTerms(posterior.MAPestimate) + timeDiff*speedEstimate;
 	
+	printf("best estimate update from %f to %f; time diff %f MAP %i = %f ms speed %f\n", tmp, bestEstimate, timeDiff,
+		   posterior.MAPestimate, posterior.getIndexInRealTerms(posterior.MAPestimate), speedEstimate);
 }
 
 void BayesianArrayStructure::calculatePosterior(){
 	//posterior.doProduct(prior, likelihood);