comparison jnmr/DynamicVector.cpp @ 46:43edc8abe2a7

Fixed bug in complex update due to mismatch between ms and vector units

 		array.push_back(0);
 	}
 	length = len;
 	arraySize = array.size();
 	integratedEstimate = length/2;
+	MAPestimate = length/2;
+	printf("array size is %i\n", arraySize);
 }
 
 
 double DynamicVector::getMaximum(){
 	int i;

 			MAPestimate = i;
 		}
 	}
 	maximumValue = max;
 	return max;
+}
+
+int DynamicVector::getMAPestimate(){
+	int i;
+	double max = 0;
+	for (i=0;i < length;i++){	
+		if (array[i] > max){
+			max = array[i];
+			MAPestimate = i;
+		}
+	}
+	maximumValue = max;
+	return MAPestimate;
 }
 
 double DynamicVector::getIntegratedEstimate(){
 	//returns the index of the integrated average - where the probability distribution is centred
 	integratedEstimate = 0;

 
 void DynamicVector::printArray(){
 	for (int i = 0;i < arraySize;i++){
 		printf("[%i] = %f\n", i, array[i]);
 	}
+	printf("Offset %f map estimate %i == %f ms\n", offset, MAPestimate, getIndexInRealTerms(MAPestimate));
 }
 
 void DynamicVector::translateDistribution(int translationIndex){
 	int tmpIndex;
 	DoubleVector tmpArray;

 	tmpArray.clear();
 	//now delete tmp array
 }
 
 void DynamicVector::addGaussianShape(const double& mean, const double& StdDev, double factor){
-	
+	//USES THE INDICES OF THE MATRIX AS MEAN AND STD DEV
 	int i;
 	double std_dev_factor = (2*StdDev*StdDev);
 	factor *= (1/(StdDev*sqrt(2*PI)));
 	int maxVal = min((int) array.size(), (int)(mean + 4.8*StdDev));
 	int minVal = max(0, (int)(mean - 4.8*StdDev));

 //	addGaussianShapeByLookupTable(mean, StdDev, factor);
 }
 
 
 void DynamicVector::addGaussianShapeFromRealTime(const double& actualTime, const double& StdDev, double factor){
-	
+	//USES THE ACTUAL VALUES IN MS AS MEAN (TIME) AND STD DEV
+	
+	double StdDevAsIndex = StdDev/scalar;
 	double mean = getRealTermsAsIndex(actualTime);
-	printf("Gaussian realtime %f at index %f\n", actualTime, mean);
-	int i;
-	double std_dev_factor = (2*StdDev*StdDev);
-	factor *= (1/(StdDev*sqrt(2*PI)));
-	int maxVal = min((int) array.size(), (int)(mean + 4.8*StdDev));
-	int minVal = max(0, (int)(mean - 4.8*StdDev));
+//	printf("Gaussian realtime %f at index %f std dev %f in index %f \n", actualTime, mean, StdDev, StdDevAsIndex);
+	int i;
+	double std_dev_factor = (2*StdDevAsIndex*StdDevAsIndex);
+	factor *= (1/(StdDevAsIndex*sqrt(2*PI)));
+	int maxVal = min((int) array.size(), (int)(mean + 4.8*StdDevAsIndex));
+	int minVal = max(0, (int)(mean - 4.8*StdDevAsIndex));
 	
 	for (i=minVal;i < maxVal;i++){
 		array[i] += factor*exp(-1*(i-mean)*(i-mean)/(std_dev_factor));
 	}
 	

 	value -= offset;
 	value /= scalar;
 	
 	return value;
 	
+}
+
+double DynamicVector::millisToVectorUnits(const double& millis){
+	return millis/scalar;
 }
 
 double DynamicVector::getValueAtMillis(const double& millis){
 	
 	int index = round(getRealTermsAsIndex(millis));