andrew@0
|
1 /*
|
andrew@0
|
2 * BayesianArrayStructure.cpp
|
andrew@0
|
3 * midiCannamReader
|
andrew@0
|
4 *
|
andrew@0
|
5 * Created by Andrew on 17/07/2011.
|
andrew@0
|
6 * Copyright 2011 QMUL. All rights reserved.
|
andrew@0
|
7 *
|
andrew@0
|
8 */
|
andrew@0
|
9
|
andrew@0
|
10 //look at reset speed to one - what does this do? - get rid of?
|
andrew@0
|
11
|
andrew@0
|
12
|
andrew@0
|
13 #include "BayesianArrayStructure.h"
|
andrew@0
|
14
|
andrew@0
|
15 BayesianArrayStructure::BayesianArrayStructure(){
|
andrew@0
|
16 printf("Bayesian structure: DeFault constructor called");
|
andrew@0
|
17
|
andrew@4
|
18 usingIntegratedTempoEstimate = false;// use max index
|
andrew@7
|
19 updatingSpeedDistribution = false;
|
andrew@0
|
20
|
andrew@0
|
21 relativeSpeedLikelihoodStdDev = 5.0;
|
andrew@0
|
22
|
andrew@0
|
23 prior.createVector(1);
|
andrew@0
|
24 likelihood.createVector(1);
|
andrew@0
|
25 posterior.createVector(1);
|
andrew@0
|
26
|
andrew@0
|
27 speedPriorValue = 1.0;//default value for the speed prior
|
andrew@0
|
28 speedEstimate = speedPriorValue;
|
andrew@0
|
29
|
andrew@0
|
30 lastEventTime = 0;//ofGetElapsedTimeMillis();
|
andrew@0
|
31
|
andrew@0
|
32 tmpBestEstimate = 0;
|
andrew@5
|
33 crossUpdateTimeThreshold = 60;
|
andrew@3
|
34 priorWidth = 20;
|
andrew@0
|
35
|
andrew@0
|
36 }
|
andrew@0
|
37
|
andrew@0
|
38 BayesianArrayStructure::BayesianArrayStructure(int length){
|
andrew@0
|
39 printf("BAYESIAN STURCTURE CREATED LENGTH: %i\n", length);
|
andrew@0
|
40 //this constructor isnt called it seems
|
andrew@0
|
41 prior.createVector(length);
|
andrew@0
|
42 likelihood.createVector(length);
|
andrew@0
|
43 posterior.createVector(length);
|
andrew@0
|
44
|
andrew@0
|
45 lastEventTime = 0;
|
andrew@0
|
46
|
andrew@0
|
47
|
andrew@0
|
48 }
|
andrew@0
|
49
|
andrew@0
|
50
|
andrew@0
|
51
|
andrew@0
|
52 void BayesianArrayStructure::resetSize(int length){
|
andrew@0
|
53 printf("BAYESIAN STRUCTURE size is : %i\n", length);
|
andrew@0
|
54
|
andrew@0
|
55 prior.createVector(length);
|
andrew@0
|
56 likelihood.createVector(length);
|
andrew@0
|
57 posterior.createVector(length);
|
andrew@0
|
58
|
andrew@0
|
59 acceleration.createVector(length);
|
andrew@0
|
60
|
andrew@0
|
61 }
|
andrew@0
|
62
|
andrew@0
|
63 void BayesianArrayStructure::resetSpeedSize(int length){
|
andrew@0
|
64 printf("BAYESIAN reset SPEED size is : %i\n", length);
|
andrew@0
|
65
|
andrew@0
|
66 relativeSpeedPrior.createVector(length);
|
andrew@0
|
67 relativeSpeedLikelihood.createVector(length);
|
andrew@0
|
68 relativeSpeedPosterior.createVector(length);
|
andrew@0
|
69 tmpPosteriorForStorage.createVector(length);
|
andrew@0
|
70
|
andrew@0
|
71
|
andrew@0
|
72
|
andrew@0
|
73 }
|
andrew@0
|
74
|
andrew@0
|
75 void BayesianArrayStructure::setRelativeSpeedScalar(double f){
|
andrew@0
|
76 relativeSpeedPrior.scalar = f;
|
andrew@0
|
77 relativeSpeedPosterior.scalar = f;
|
andrew@0
|
78 relativeSpeedLikelihood.scalar = f;
|
andrew@0
|
79 }
|
andrew@0
|
80
|
andrew@0
|
81 void BayesianArrayStructure::resetSpeedToOne(){
|
andrew@0
|
82 relativeSpeedPrior.zero();
|
andrew@0
|
83 relativeSpeedPosterior.zero();
|
andrew@0
|
84 relativeSpeedLikelihood.zero();
|
andrew@0
|
85
|
andrew@0
|
86
|
andrew@0
|
87 relativeSpeedPosterior.addGaussianShape(100, 20, 0.8);
|
andrew@0
|
88 relativeSpeedPosterior.renormalise();
|
andrew@0
|
89 relativeSpeedPosterior.getMaximum();
|
andrew@0
|
90
|
andrew@0
|
91 setSpeedPrior(speedPriorValue);
|
andrew@0
|
92 speedEstimate = speedPriorValue;
|
andrew@0
|
93
|
andrew@0
|
94 prior.zero();
|
andrew@0
|
95 posterior.zero();
|
andrew@0
|
96
|
andrew@0
|
97 posterior.addToIndex(0, 1);
|
andrew@0
|
98 posterior.renormalise();
|
andrew@0
|
99
|
andrew@0
|
100 }
|
andrew@0
|
101
|
andrew@0
|
102 void BayesianArrayStructure::setSpeedPrior(double f){
|
andrew@0
|
103 speedPriorValue = f;
|
andrew@0
|
104 int index = relativeSpeedPosterior.getRealTermsAsIndex(speedPriorValue);
|
andrew@0
|
105 relativeSpeedPosterior.zero();
|
andrew@0
|
106 relativeSpeedPosterior.addGaussianShape(index, priorWidth, 0.8);
|
andrew@4
|
107 printf("speed adding to index for 1 = %f\n", relativeSpeedPosterior.getRealTermsAsIndex(1));
|
andrew@7
|
108 relativeSpeedPosterior.addToIndex(relativeSpeedPosterior.getRealTermsAsIndex(1), 0.1);
|
andrew@7
|
109 relativeSpeedPosterior.addGaussianShapeFromRealTime(1, 3, 0.5);
|
andrew@4
|
110
|
andrew@0
|
111 relativeSpeedPosterior.renormalise();
|
andrew@0
|
112 relativeSpeedPosterior.getMaximum();
|
andrew@0
|
113 relativeSpeedPrior.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
114 printf("BAYES STRUCTU ' SPEED PRIOR %f . index %i\n", speedPriorValue, index);
|
andrew@0
|
115
|
andrew@0
|
116 }
|
andrew@0
|
117
|
andrew@0
|
118
|
andrew@0
|
119 void BayesianArrayStructure::setPositionDistributionScalar(double f){
|
andrew@0
|
120 if (f > 0){
|
andrew@0
|
121 prior.scalar = f;
|
andrew@0
|
122 posterior.scalar = f;
|
andrew@0
|
123 likelihood.scalar = f;
|
andrew@0
|
124 }
|
andrew@0
|
125 }
|
andrew@0
|
126
|
andrew@0
|
127 void BayesianArrayStructure::simpleExample(){
|
andrew@0
|
128 relativeSpeedPosterior.getMaximum();
|
andrew@0
|
129 relativeSpeedPrior.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
130 }
|
andrew@0
|
131
|
andrew@0
|
132 void BayesianArrayStructure::copyPriorToPosterior(){
|
andrew@0
|
133
|
andrew@0
|
134 for (int i = 0;i < prior.arraySize;i++){
|
andrew@0
|
135 posterior.array[i] = prior.array[i];
|
andrew@0
|
136 }
|
andrew@0
|
137 }
|
andrew@0
|
138
|
andrew@0
|
139 void BayesianArrayStructure::setStartPlaying(){
|
andrew@0
|
140
|
andrew@0
|
141 lastEventTime = 0;
|
andrew@0
|
142 bestEstimate = 0;
|
andrew@0
|
143 lastBestEstimateUpdateTime = 0;
|
andrew@3
|
144
|
andrew@0
|
145 if (*realTimeMode)
|
andrew@0
|
146 lastBestEstimateUpdateTime = ofGetElapsedTimeMillis();
|
andrew@0
|
147 //cannot just be zero - offline bug
|
andrew@0
|
148 //printf("start playing - best estimate %f\n", lastBestEstimateUpdateTime);
|
andrew@0
|
149
|
andrew@0
|
150 resetArrays();
|
andrew@0
|
151 }
|
andrew@0
|
152
|
andrew@0
|
153 void BayesianArrayStructure::resetArrays(){
|
andrew@0
|
154 //called when we start playing
|
andrew@0
|
155
|
andrew@0
|
156 prior.zero();
|
andrew@0
|
157 likelihood.zero();
|
andrew@0
|
158 posterior.zero();
|
andrew@0
|
159
|
andrew@0
|
160 updateCounter = 0;
|
andrew@0
|
161
|
andrew@0
|
162 posterior.offset = -1000;
|
andrew@0
|
163 setNewDistributionOffsets(0);
|
andrew@0
|
164
|
andrew@0
|
165 int zeroIndex = posterior.getRealTermsAsIndex(0);
|
andrew@3
|
166 printf("ZERO INDEX %i\n", zeroIndex);
|
andrew@0
|
167
|
andrew@7
|
168 posterior.addGaussianShapeFromRealTime(0, 60, 1);//one way to add at x msec
|
andrew@7
|
169 // posterior.addGaussianShape(posterior.getRealTermsAsIndex(10), 50, 1);//alternative way
|
andrew@3
|
170
|
andrew@3
|
171 //posterior.addToIndex(0, 1);
|
andrew@0
|
172 likelihood.addConstant(1);
|
andrew@0
|
173
|
andrew@0
|
174 updateCounter = 0;
|
andrew@0
|
175
|
andrew@0
|
176
|
andrew@0
|
177 printf("bayes reset arrays - best estimate %f\n", lastBestEstimateUpdateTime);
|
andrew@0
|
178
|
andrew@0
|
179 setSpeedPrior(speedPriorValue);
|
andrew@3
|
180 relativeSpeedPosterior.copyFromDynamicVector(relativeSpeedPrior);
|
andrew@3
|
181
|
andrew@0
|
182 }
|
andrew@0
|
183
|
andrew@0
|
184
|
andrew@0
|
185 void BayesianArrayStructure::zeroArrays(){
|
andrew@0
|
186 prior.zero();
|
andrew@0
|
187 likelihood.zero();
|
andrew@0
|
188 posterior.zero();
|
andrew@0
|
189
|
andrew@0
|
190 relativeSpeedPrior.zero();
|
andrew@0
|
191 relativeSpeedPosterior.zero();
|
andrew@0
|
192 relativeSpeedLikelihood.zero();
|
andrew@0
|
193
|
andrew@0
|
194 }
|
andrew@0
|
195
|
andrew@4
|
196 /*
|
andrew@0
|
197 void BayesianArrayStructure::updateTmpBestEstimate(const double& timeDifference){
|
andrew@0
|
198 //input is the time since the start of playing
|
andrew@0
|
199 // double timeDiff = ofGetElapsedTimeMillis() - lastEventTime;//lastBestEstimateUpdateTime;
|
andrew@0
|
200 double timeDiff = timeDifference;
|
andrew@0
|
201 if (*realTimeMode)
|
andrew@0
|
202 timeDiff = ofGetElapsedTimeMillis() - lastBestEstimateUpdateTime;
|
andrew@0
|
203
|
andrew@0
|
204 double tmp = relativeSpeedPosterior.getIntegratedEstimate();
|
andrew@0
|
205 tmpBestEstimate = posterior.getIndexInRealTerms(posterior.MAPestimate) + timeDiff*relativeSpeedPosterior.getIndexInRealTerms(relativeSpeedPosterior.integratedEstimate);
|
andrew@0
|
206 //
|
andrew@0
|
207 //printf("tmp best %f and best %f time diff %f posterior MAP %f at speed %f\n", 0Estimate, bestEstimate, timeDifference, posterior.getIndexInRealTerms(posterior.MAPestimate), relativeSpeedPosterior.getIndexInRealTerms(relativeSpeedPosterior.integratedEstimate));
|
andrew@0
|
208 //lastBestEstimateUpdateTime = ofGetElapsedTimeMillis();
|
andrew@0
|
209 }
|
andrew@4
|
210 */
|
andrew@4
|
211
|
andrew@0
|
212 void BayesianArrayStructure::updateBestEstimate(const double& timeDifference){
|
andrew@0
|
213 // double timeDiff = ofGetElapsedTimeMillis() - lastEventTime;//
|
andrew@3
|
214 double tmp = bestEstimate;
|
andrew@4
|
215 printf("best est routine: posterior offset %f\n", posterior.offset);
|
andrew@0
|
216
|
andrew@0
|
217 double timeDiff = timeDifference;
|
andrew@0
|
218
|
andrew@0
|
219 //Using timedifferencfe here will make it go wrong. Is time since beginning of playing
|
andrew@0
|
220
|
andrew@0
|
221 if (*realTimeMode)
|
andrew@0
|
222 timeDiff = ofGetElapsedTimeMillis() - lastBestEstimateUpdateTime;
|
andrew@0
|
223
|
andrew@0
|
224 //lastbest is time we started playing
|
andrew@4
|
225 /*
|
andrew@0
|
226 if (usingIntegratedTempoEstimate)
|
andrew@0
|
227 speedEstimateIndex = relativeSpeedPosterior.getIntegratedEstimate();
|
andrew@0
|
228 else
|
andrew@4
|
229 speedEstimateIndex = relativeSpeedPosterior.getMAPestimate();
|
andrew@4
|
230 */
|
andrew@4
|
231 speedEstimateIndex = getSpeedEstimateIndex();
|
andrew@0
|
232
|
andrew@0
|
233 speedEstimate = relativeSpeedPosterior.getIndexInRealTerms(speedEstimateIndex);
|
andrew@0
|
234 bestEstimate = posterior.getIndexInRealTerms(posterior.MAPestimate) + timeDiff*speedEstimate;
|
andrew@0
|
235
|
andrew@4
|
236 printf("best estimate update from %f to %f; time diff %f MAP %i = %f ms speed index %f est %f SpeedxTime %f\n", tmp, bestEstimate, timeDiff,
|
andrew@4
|
237 posterior.MAPestimate, posterior.getIndexInRealTerms(posterior.MAPestimate), speedEstimateIndex, speedEstimate, timeDiff*speedEstimate);
|
andrew@0
|
238 }
|
andrew@0
|
239
|
andrew@0
|
240 void BayesianArrayStructure::calculatePosterior(){
|
andrew@0
|
241 //posterior.doProduct(prior, likelihood);
|
andrew@4
|
242 assert(posterior.offset == prior.offset);
|
andrew@0
|
243
|
andrew@0
|
244 int i;
|
andrew@0
|
245 for (i = 0;i < posterior.length;i++){
|
andrew@0
|
246 posterior.array[i] = likelihood.array[i] * prior.array[i];
|
andrew@0
|
247 }
|
andrew@0
|
248
|
andrew@0
|
249 posterior.renormalise();
|
andrew@0
|
250
|
andrew@6
|
251 //tmp print stuff
|
andrew@6
|
252 printf("After CALC");
|
andrew@6
|
253 printPostOffset();
|
andrew@6
|
254
|
andrew@0
|
255 }
|
andrew@0
|
256
|
andrew@0
|
257
|
andrew@4
|
258 double BayesianArrayStructure::getSpeedEstimateIndex(){
|
andrew@4
|
259 if (usingIntegratedTempoEstimate)
|
andrew@4
|
260 return relativeSpeedPosterior.getIntegratedEstimate();
|
andrew@4
|
261 else
|
andrew@4
|
262 return relativeSpeedPosterior.getMAPestimate();
|
andrew@4
|
263 }
|
andrew@0
|
264
|
andrew@0
|
265
|
andrew@0
|
266 void BayesianArrayStructure::setNewDistributionOffsets(const double& newOffset){
|
andrew@4
|
267
|
andrew@4
|
268 printf("prior offset was %f now %f\n", prior.offset, newOffset);
|
andrew@4
|
269
|
andrew@0
|
270 prior.offset = newOffset;
|
andrew@0
|
271 likelihood.offset = newOffset;
|
andrew@4
|
272
|
andrew@0
|
273 //posterior.offset = newOffset;
|
andrew@0
|
274 }
|
andrew@0
|
275
|
andrew@0
|
276
|
andrew@6
|
277 void BayesianArrayStructure::updateBayesianDistributions(const double& newEventTime){
|
andrew@6
|
278
|
andrew@6
|
279 //NEED TO CHECK HERE THAT THEY HAVE THE SAME OFFSETS
|
andrew@6
|
280 prior.copyFromDynamicVector(posterior);//try the otehr way
|
andrew@6
|
281
|
andrew@6
|
282 //bayesianStruct.copyPriorToPosterior();
|
andrew@6
|
283 //need to get new MAP position and set the offset of the arrays
|
andrew@6
|
284 //currently bestEstimate is the approx for the new MAP position
|
andrew@6
|
285 // int tmpMap = bayesianStruct.posterior.getMAPestimate();
|
andrew@6
|
286
|
andrew@6
|
287 double timeDifference = newEventTime - lastEventTime;
|
andrew@6
|
288 // printf("updating distributions at time %f diff %f offset %f tmpmap est %i\n", newEventTime, timeDifference, bayesianStruct.posterior.offset, tmpMap);
|
andrew@6
|
289
|
andrew@6
|
290 //addnoise to the tempo distribution
|
andrew@6
|
291 //bayesianStruct.decaySpeedDistribution(timeDifference);
|
andrew@6
|
292
|
andrew@7
|
293 if (timeDifference > 50 && updatingSpeedDistribution){
|
andrew@6
|
294 addGaussianNoiseToSpeedPosterior(timeDifference * 10.0 / 100.);
|
andrew@6
|
295 }
|
andrew@6
|
296
|
andrew@6
|
297 printPostOffset();
|
andrew@6
|
298
|
andrew@6
|
299 updateBestEstimate(timeDifference);
|
andrew@6
|
300 lastBestEstimateUpdateTime = newEventTime;//getTimeNow(timePlayed);
|
andrew@6
|
301
|
andrew@6
|
302
|
andrew@6
|
303 setNewDistributionOffsets(max(0., bestEstimate - (prior.scalar*prior.arraySize/2)));
|
andrew@6
|
304 crossUpdateArrays(posterior, relativeSpeedPosterior, timeDifference);
|
andrew@6
|
305
|
andrew@6
|
306 //i.e. using the same offset as prior
|
andrew@6
|
307 posterior.offset = prior.offset;//
|
andrew@6
|
308
|
andrew@6
|
309 // float tmpPrior = max(0., bestEstimate - (prior.scalar*prior.arraySize/2));// prior.offset = max(0., bestEstimate - (prior.scalar*prior.arraySize/2));
|
andrew@6
|
310 // printf("Using prior offset of %f not %f\n", tmpPrior, prior.offset);
|
andrew@6
|
311
|
andrew@6
|
312 lastEventTime = newEventTime;//lastEventTime = ofGetElapsedTimeMillis();
|
andrew@6
|
313
|
andrew@6
|
314 }
|
andrew@6
|
315
|
andrew@6
|
316
|
andrew@0
|
317 void BayesianArrayStructure::crossUpdateArrays(DynamicVector& position, DynamicVector& speed, double timeDifference){
|
andrew@0
|
318 //set the cutoff for offset of position first! XXX
|
andrew@0
|
319
|
andrew@0
|
320 // printf("time difference %f, ", timeDifference);
|
andrew@0
|
321
|
andrew@0
|
322 double timeDifferenceInPositionVectorUnits = timeDifference / prior.scalar;
|
andrew@0
|
323
|
andrew@4
|
324 printf("CROSS UPDATE time diff %f ms is %f units; ", timeDifference, timeDifferenceInPositionVectorUnits);
|
andrew@0
|
325 prior.zero();//kill prior
|
andrew@4
|
326
|
andrew@4
|
327 // calculateNewPriorOffset(timeDifference);//dioesnt do anything
|
andrew@4
|
328
|
andrew@5
|
329 // printf("new prior offset %f and post offset %f\n", prior.offset, posterior.offset);
|
andrew@0
|
330
|
andrew@0
|
331 if (timeDifferenceInPositionVectorUnits > crossUpdateTimeThreshold)
|
andrew@0
|
332 complexCrossUpdate(timeDifferenceInPositionVectorUnits);
|
andrew@0
|
333 else
|
andrew@0
|
334 translateByMaximumSpeed(timeDifferenceInPositionVectorUnits);
|
andrew@0
|
335
|
andrew@0
|
336
|
andrew@0
|
337 updateCounter++;
|
andrew@0
|
338 prior.renormalise();
|
andrew@0
|
339
|
andrew@0
|
340 }
|
andrew@0
|
341
|
andrew@0
|
342 void BayesianArrayStructure::complexCrossUpdate(const double& timeDifferenceInPositionVectorUnits){
|
andrew@4
|
343
|
andrew@5
|
344
|
andrew@5
|
345 printf("before cross c : posterior map is %i = %f ms time diff pos vec %f\n", posterior.getMAPestimate(), posterior.getIndexInRealTerms(prior.getMAPestimate()), timeDifferenceInPositionVectorUnits);
|
andrew@5
|
346
|
andrew@0
|
347 int distanceMoved, newPriorIndex;
|
andrew@0
|
348
|
andrew@0
|
349 double speedValue = relativeSpeedPosterior.offset;
|
andrew@0
|
350
|
andrew@0
|
351 for (int i = 0;i < relativeSpeedPosterior.arraySize;i++){
|
andrew@0
|
352
|
andrew@0
|
353 // double speedValue = relativeSpeedPosterior.getIndexInRealTerms(i);//so for scalar 0.01, 50 -> speed value of 0.5
|
andrew@0
|
354
|
andrew@0
|
355 //so we have moved
|
andrew@0
|
356 distanceMoved = round(timeDifferenceInPositionVectorUnits * speedValue);//round the value
|
andrew@5
|
357 // printf("Speed value %f time %f gives distance %i\n", speedValue, timeDifferenceInPositionVectorUnits, distanceMoved);
|
andrew@5
|
358
|
andrew@0
|
359 if (relativeSpeedPosterior.array[i] != 0){
|
andrew@4
|
360
|
andrew@0
|
361 double speedContribution = relativeSpeedPosterior.array[i];
|
andrew@0
|
362
|
andrew@4
|
363 // printf("speed [%i](val[%f]) gives %f moved %i in %f units \n", i, relativeSpeedPosterior.array[i], speedValue, distanceMoved, timeDifferenceInPositionVectorUnits);
|
andrew@0
|
364
|
andrew@4
|
365 //1/2/12 deleted line
|
andrew@4
|
366 newPriorIndex = posterior.offset - prior.offset + distanceMoved;//i.e. where post[0] goes to in terms of prior at this speed
|
andrew@5
|
367 int postIndex = 0;//index of posterior that will contribute
|
andrew@5
|
368
|
andrew@4
|
369 while (postIndex < posterior.arraySize && newPriorIndex < prior.arraySize){
|
andrew@4
|
370
|
andrew@4
|
371 //did use a for loop
|
andrew@4
|
372 // for (postIndex = 0;postIndex < posterior.arraySize;postIndex++){
|
andrew@0
|
373 //old posterior contributing to new prior
|
andrew@4
|
374
|
andrew@4
|
375 //would use this method
|
andrew@4
|
376 //newPriorIndex = postIndex + posterior.offset - prior.offset + distanceMoved;
|
andrew@0
|
377
|
andrew@4
|
378 if (newPriorIndex >= 0){
|
andrew@0
|
379 prior.addToIndex(newPriorIndex, posterior.array[postIndex]*speedContribution);
|
andrew@4
|
380 // printf("speed index %i new prior index %i post val %f speed contrib %f dist %i\n", i, newPriorIndex, posterior.array[postIndex], speedContribution, distanceMoved);
|
andrew@0
|
381 }
|
andrew@4
|
382 //but we actually do this for simplicity
|
andrew@4
|
383 newPriorIndex++;
|
andrew@4
|
384 postIndex++;
|
andrew@4
|
385 }//end for. now while
|
andrew@0
|
386
|
andrew@0
|
387
|
andrew@0
|
388 }//if not zero
|
andrew@5
|
389
|
andrew@5
|
390 speedValue += relativeSpeedPosterior.scalar;//optimised line
|
andrew@0
|
391 //as we wanted:
|
andrew@0
|
392 // double speedValue = relativeSpeedPosterior.getIndexInRealTerms(i);//so for scalar 0.01, 50 -> speed value of 0.5
|
andrew@5
|
393
|
andrew@0
|
394 }//end speed
|
andrew@5
|
395
|
andrew@5
|
396
|
andrew@5
|
397 printf("after cross c : prior map is %i = %f ms\n", prior.getMAPestimate(), prior.getIndexInRealTerms(prior.getMAPestimate()));
|
andrew@0
|
398 }
|
andrew@0
|
399
|
andrew@0
|
400
|
andrew@0
|
401
|
andrew@0
|
402 void BayesianArrayStructure::translateByMaximumSpeed(const double& timeDifferenceInPositionVectorUnits){
|
andrew@0
|
403
|
andrew@0
|
404 int distanceMoved, newPriorIndex;
|
andrew@0
|
405
|
andrew@0
|
406 double speedValue = relativeSpeedPosterior.getIndexInRealTerms(relativeSpeedPosterior.integratedEstimate);
|
andrew@0
|
407 //so for scalar 0.01, 50 -> speed value of 0.5
|
andrew@0
|
408 double speedContribution = relativeSpeedPosterior.array[relativeSpeedPosterior.integratedEstimate];
|
andrew@0
|
409 //so we have moved
|
andrew@0
|
410 distanceMoved = round(timeDifferenceInPositionVectorUnits * speedValue);//round the value
|
andrew@0
|
411 // printf("speed [%i] gives %f moved %i in %f units \n", i, speedValue, distanceMoved, timeDifferenceInPositionVectorUnits);
|
andrew@0
|
412
|
andrew@0
|
413 for (int postIndex = 0;postIndex < posterior.arraySize;postIndex++){
|
andrew@0
|
414 //old posterior contributing to new prior
|
andrew@0
|
415 newPriorIndex = postIndex + posterior.offset - prior.offset + distanceMoved;
|
andrew@0
|
416 if (newPriorIndex >= 0 && newPriorIndex < prior.arraySize){
|
andrew@0
|
417 prior.addToIndex(newPriorIndex, posterior.array[postIndex]*speedContribution);
|
andrew@0
|
418 }
|
andrew@0
|
419
|
andrew@0
|
420 }
|
andrew@0
|
421
|
andrew@0
|
422 }
|
andrew@0
|
423
|
andrew@0
|
424 void BayesianArrayStructure::addGaussianNoiseToSpeedPosterior(const double& std_dev){
|
andrew@0
|
425 tmpPosteriorForStorage.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
426
|
andrew@0
|
427 for (int i = 0;i < relativeSpeedPosterior.length;i++){
|
andrew@0
|
428 tmpPosteriorForStorage.addGaussianShape(i, std_dev, relativeSpeedPosterior.array[i]);
|
andrew@0
|
429 }
|
andrew@0
|
430
|
andrew@0
|
431 tmpPosteriorForStorage.renormalise();
|
andrew@0
|
432
|
andrew@0
|
433 relativeSpeedPosterior.copyFromDynamicVector(tmpPosteriorForStorage);
|
andrew@0
|
434 }
|
andrew@0
|
435
|
andrew@0
|
436
|
andrew@0
|
437 void BayesianArrayStructure::addTriangularNoiseToSpeedPosterior(const double& std_dev){
|
andrew@0
|
438 tmpPosteriorForStorage.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
439
|
andrew@0
|
440 for (int i = 0;i < relativeSpeedPosterior.length;i++){
|
andrew@0
|
441 //adding a linear amount depending on distance
|
andrew@0
|
442 tmpPosteriorForStorage.addTriangularShape(i, std_dev*2.0, relativeSpeedPosterior.array[i]);
|
andrew@0
|
443 }
|
andrew@0
|
444
|
andrew@0
|
445 tmpPosteriorForStorage.renormalise();
|
andrew@0
|
446
|
andrew@0
|
447 relativeSpeedPosterior.copyFromDynamicVector(tmpPosteriorForStorage);
|
andrew@0
|
448 }
|
andrew@0
|
449
|
andrew@0
|
450 void BayesianArrayStructure::calculateNewPriorOffset(const double& timeDifference){
|
andrew@0
|
451
|
andrew@4
|
452 // double maxSpeed = relativeSpeedPosterior.getIndexInRealTerms(relativeSpeedPosterior.integratedEstimate);
|
andrew@4
|
453
|
andrew@4
|
454 double maxSpeed = relativeSpeedPosterior.getIndexInRealTerms(getSpeedEstimateIndex());//either integrated or MAP
|
andrew@0
|
455 // printf("Maxspeed is %f\n", maxSpeed);
|
andrew@0
|
456
|
andrew@0
|
457 double priorMax = posterior.getMaximum();
|
andrew@0
|
458 double distanceTravelled = maxSpeed * (timeDifference / prior.scalar);
|
andrew@0
|
459 double newMaxLocation = posterior.MAPestimate + distanceTravelled;
|
andrew@0
|
460 // printf("MAP: %i, tim df %f, distance %f, new location %f\n", posterior.MAPestimate, timeDifference, distanceTravelled, newMaxLocation);
|
andrew@0
|
461
|
andrew@0
|
462 }
|
andrew@0
|
463
|
andrew@0
|
464
|
andrew@0
|
465 void BayesianArrayStructure::decaySpeedDistribution(double timeDifference){
|
andrew@0
|
466
|
andrew@0
|
467 // commented for the moment
|
andrew@0
|
468 double relativeAmount = max(1.0, timeDifference/1000.);
|
andrew@0
|
469 // printf("decay %f around %i \n", timeDifference, relativeSpeedPosterior.MAPestimate);
|
andrew@0
|
470 relativeAmount *= speedDecayAmount;
|
andrew@0
|
471 relativeSpeedPosterior.renormalise();
|
andrew@0
|
472 relativeSpeedPosterior.addGaussianShape(relativeSpeedPosterior.MAPestimate, speedDecayWidth, relativeAmount);
|
andrew@0
|
473
|
andrew@0
|
474 relativeSpeedPosterior.renormalise();
|
andrew@0
|
475 double newMax = relativeSpeedPosterior.getMaximum();
|
andrew@0
|
476
|
andrew@0
|
477 //old code
|
andrew@0
|
478 // relativeSpeedPosterior.addGaussianShape(relativeSpeedPosterior.MAPestimate, speedDecayWidth, 10);
|
andrew@0
|
479 //relativeSpeedPosterior.addConstant(1);
|
andrew@0
|
480
|
andrew@0
|
481 /*
|
andrew@0
|
482 relativeSpeedPrior.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
483 relativeSpeedLikelihood.zero();
|
andrew@0
|
484 relativeSpeedLikelihood.addConstant(0.2);
|
andrew@0
|
485 relativeSpeedLikelihood.addGaussianShape(relativeSpeedPosterior.maximumValue, speedDecayWidth, relativeAmount);
|
andrew@0
|
486 relativeSpeedPosterior.doProduct(relativeSpeedPrior, relativeSpeedLikelihood);
|
andrew@0
|
487 relativeSpeedPosterior.renormalise();
|
andrew@0
|
488 */
|
andrew@0
|
489
|
andrew@0
|
490
|
andrew@0
|
491
|
andrew@0
|
492 }
|
andrew@0
|
493
|
andrew@0
|
494 void BayesianArrayStructure::setLikelihoodToConstant(){
|
andrew@0
|
495 //set new likelihood
|
andrew@0
|
496 relativeSpeedLikelihood.zero();
|
andrew@0
|
497 relativeSpeedLikelihood.addConstant(speedLikelihoodNoise);
|
andrew@0
|
498 }
|
andrew@0
|
499
|
andrew@0
|
500
|
andrew@0
|
501 void BayesianArrayStructure::updateTempoLikelihood(const double& speedRatio, const double& matchFactor){
|
andrew@0
|
502
|
andrew@0
|
503 //speedratio is speed of played relative to the recording
|
andrew@0
|
504
|
andrew@0
|
505 double index = relativeSpeedLikelihood.getRealTermsAsIndex(speedRatio);
|
andrew@0
|
506 // printf("index of likelihood would be %f for ratio %f\n", index, speedRatio);
|
andrew@0
|
507 if (index >= 0 && index < relativeSpeedPrior.length){
|
andrew@0
|
508 relativeSpeedLikelihood.addGaussianShape(index , relativeSpeedLikelihoodStdDev, matchFactor);
|
andrew@0
|
509 }
|
andrew@0
|
510 }
|
andrew@0
|
511
|
andrew@0
|
512
|
andrew@0
|
513
|
andrew@0
|
514 void BayesianArrayStructure::updateTempoDistribution(){
|
andrew@0
|
515
|
andrew@0
|
516 //copy posterior to prior
|
andrew@0
|
517 relativeSpeedPrior.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
518
|
andrew@0
|
519 //update
|
andrew@0
|
520 relativeSpeedPosterior.doProduct(relativeSpeedPrior, relativeSpeedLikelihood);
|
andrew@0
|
521
|
andrew@0
|
522 //normalise
|
andrew@0
|
523 relativeSpeedPosterior.renormalise();
|
andrew@0
|
524
|
andrew@0
|
525 relativeSpeedPosterior.getMaximum();
|
andrew@0
|
526
|
andrew@0
|
527 //relativeSpeedPosterior.updateIntegratedEstimate(); - could be swayed when off to side
|
andrew@0
|
528 //so now limited to where there is room sround the MAP estimate
|
andrew@0
|
529 relativeSpeedPosterior.updateLimitedIntegratedEstimate();
|
andrew@0
|
530
|
andrew@0
|
531 speedEstimate = relativeSpeedPosterior.getIndexInRealTerms(relativeSpeedPosterior.integratedEstimate);
|
andrew@0
|
532 }
|
andrew@0
|
533
|
andrew@0
|
534
|
andrew@0
|
535 void BayesianArrayStructure::calculateTempoUpdate(){
|
andrew@0
|
536 //copy posterior to prior
|
andrew@0
|
537 relativeSpeedPrior.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
538
|
andrew@0
|
539 //update
|
andrew@0
|
540 relativeSpeedPosterior.doProduct(relativeSpeedPrior, relativeSpeedLikelihood);
|
andrew@0
|
541
|
andrew@0
|
542 //normalise
|
andrew@0
|
543 relativeSpeedPosterior.renormalise();
|
andrew@0
|
544
|
andrew@0
|
545 relativeSpeedPosterior.getMaximum();
|
andrew@0
|
546
|
andrew@0
|
547 }
|
andrew@0
|
548
|
andrew@0
|
549
|
andrew@0
|
550 void BayesianArrayStructure::drawArrays(){
|
andrew@0
|
551
|
andrew@0
|
552 //bayesArray.drawFloatArray(&bayesArray.prior[0], 0, 200);
|
andrew@0
|
553 //bayesArray.drawFloatArray(&bayesArray.prior[0], 0, 200);
|
andrew@0
|
554
|
andrew@0
|
555 int displaySize = prior.arraySize;
|
andrew@0
|
556 ofSetColor(0,0,255);
|
andrew@0
|
557 prior.drawVector(0, displaySize);
|
andrew@0
|
558 ofSetColor(0,255,0);
|
andrew@0
|
559 likelihood.drawVector(0, displaySize);
|
andrew@0
|
560 ofSetColor(255,0,255);
|
andrew@0
|
561 posterior.drawVector(0, displaySize);
|
andrew@0
|
562
|
andrew@0
|
563
|
andrew@0
|
564
|
andrew@0
|
565 }
|
andrew@0
|
566
|
andrew@0
|
567
|
andrew@0
|
568 void BayesianArrayStructure::drawTempoArrays(){
|
andrew@0
|
569 ofSetColor(0,0,255);
|
andrew@0
|
570 // relativeSpeedPrior.drawVector(0, relativeSpeedPrior.arraySize);
|
andrew@0
|
571
|
andrew@0
|
572 ofSetColor(0,150,255);
|
andrew@0
|
573 relativeSpeedLikelihood.drawVector(0, relativeSpeedLikelihood.arraySize);
|
andrew@0
|
574
|
andrew@0
|
575 // relativeSpeedLikelihood.drawConstrainedVector(0, 199, 0, 1000);// relativeSpeedLikelihood.arraySize);
|
andrew@0
|
576 ofSetColor(255,0,0);
|
andrew@0
|
577 relativeSpeedPosterior.drawVector(0, relativeSpeedPosterior.arraySize);
|
andrew@0
|
578
|
andrew@0
|
579 // ofSetColor(0,0,255);
|
andrew@0
|
580 // tmpPosteriorForStorage.drawVector(0, tmpPosteriorForStorage.arraySize);
|
andrew@0
|
581
|
andrew@0
|
582 ofSetColor(255,255, 255);
|
andrew@0
|
583 ofLine(screenWidth/2, 0, screenWidth/2, ofGetHeight());//middle of screen
|
andrew@0
|
584
|
andrew@0
|
585 ofSetColor(25, 0, 250);
|
andrew@0
|
586 double fractionOfScreen = ((double)relativeSpeedPosterior.integratedEstimate / relativeSpeedPosterior.length);
|
andrew@0
|
587 ofLine(screenWidth * fractionOfScreen, 0, screenWidth * fractionOfScreen, ofGetHeight());
|
andrew@0
|
588
|
andrew@0
|
589 ofSetColor(255, 0, 20);
|
andrew@0
|
590 fractionOfScreen = ((double)relativeSpeedPosterior.MAPestimate / relativeSpeedPosterior.length);
|
andrew@0
|
591 ofLine(screenWidth * fractionOfScreen, 0, screenWidth * fractionOfScreen, ofGetHeight());
|
andrew@0
|
592
|
andrew@0
|
593
|
andrew@0
|
594 }
|
andrew@0
|
595
|
andrew@0
|
596
|
andrew@0
|
597 void BayesianArrayStructure::drawArraysRelativeToTimeframe(const double& startTimeMillis, const double& endTimeMillis){
|
andrew@0
|
598
|
andrew@0
|
599 screenWidth = ofGetWidth();
|
andrew@0
|
600
|
andrew@0
|
601 int startArrayIndex = 0;
|
andrew@0
|
602
|
andrew@0
|
603 if (prior.getIndexInRealTerms(prior.arraySize-1) > startTimeMillis){
|
andrew@0
|
604 //i.e. the array is on the page
|
andrew@0
|
605
|
andrew@0
|
606 while (prior.getIndexInRealTerms(startArrayIndex) < startTimeMillis){
|
andrew@0
|
607 startArrayIndex++;
|
andrew@0
|
608 }
|
andrew@0
|
609 int endArrayIndex = prior.arraySize-1;
|
andrew@0
|
610 //could find constraints here
|
andrew@0
|
611 if (prior.getIndexInRealTerms(prior.arraySize-1) > endTimeMillis)
|
andrew@0
|
612 endArrayIndex = (floor)((endTimeMillis - prior.offset)/prior.scalar);
|
andrew@0
|
613
|
andrew@0
|
614 //so we need to figure where start and end array are on screen
|
andrew@0
|
615 int startScreenPosition, endScreenPosition;
|
andrew@0
|
616 double screenWidthMillis = endTimeMillis - startTimeMillis;
|
andrew@0
|
617
|
andrew@0
|
618 startScreenPosition = (prior.getIndexInRealTerms(startArrayIndex) - startTimeMillis)*screenWidth/screenWidthMillis;
|
andrew@0
|
619 endScreenPosition = (double)(prior.getIndexInRealTerms(endArrayIndex) - startTimeMillis)*screenWidth/screenWidthMillis;
|
andrew@0
|
620
|
andrew@0
|
621 ofSetColor(0,0,100);
|
andrew@0
|
622 string relativeString = " offset "+ofToString(prior.offset, 1);//starttimes("+ofToString(startTimeMillis)+", "+ofToString(endTimeMillis);
|
andrew@0
|
623 relativeString += ": index "+ofToString(startArrayIndex)+" , "+ofToString(endArrayIndex)+" [";
|
andrew@0
|
624 // relativeString += ofToString(prior.getIndexInRealTerms(endArrayIndex), 3)+"] (sc-width:"+ofToString(screenWidthMillis, 1)+") ";
|
andrew@0
|
625 relativeString += " mapped to screen "+ofToString(startScreenPosition)+" , "+ofToString(endScreenPosition);
|
andrew@0
|
626 // ofDrawBitmapString(relativeString, 100, 180);
|
andrew@0
|
627
|
andrew@0
|
628
|
andrew@0
|
629
|
andrew@0
|
630 ofSetColor(100,100,100);//255, 255, 0);
|
andrew@0
|
631 likelihood.drawConstrainedVector(startArrayIndex, endArrayIndex, startScreenPosition, endScreenPosition);
|
andrew@0
|
632
|
andrew@0
|
633 // ofSetColor(0,0,200);
|
andrew@0
|
634 ofSetColor(170,170,170);//00,200);
|
andrew@0
|
635 prior.drawConstrainedVector(startArrayIndex, endArrayIndex, startScreenPosition, endScreenPosition);
|
andrew@0
|
636
|
andrew@0
|
637 ofSetColor(0,0,150);
|
andrew@0
|
638 // ofSetColor(200, 0, 0);
|
andrew@0
|
639 posterior.drawConstrainedVector(startArrayIndex, endArrayIndex, startScreenPosition, endScreenPosition);
|
andrew@0
|
640
|
andrew@0
|
641
|
andrew@0
|
642 // ofSetColor(0, 200, 255);
|
andrew@0
|
643 // acceleration.drawConstrainedVector(startArrayIndex, endArrayIndex, startScreenPosition, endScreenPosition);
|
andrew@0
|
644
|
andrew@0
|
645
|
andrew@0
|
646 }
|
andrew@0
|
647
|
andrew@0
|
648 }
|
andrew@0
|
649
|
andrew@0
|
650
|
andrew@6
|
651 void BayesianArrayStructure::printPostOffset(){
|
andrew@6
|
652 double tmp = posterior.getMAPestimate();
|
andrew@6
|
653 printf(" MAP index %i post offset %f == %f ms\n", posterior.MAPestimate, posterior.offset, posterior.getIndexInRealTerms(posterior.MAPestimate));
|
andrew@6
|
654 }
|
andrew@6
|
655
|
andrew@0
|
656 /*
|
andrew@0
|
657
|
andrew@0
|
658 void BayesianArrayStructure::updateTempoDistribution(const double& speedRatio, const double& matchFactor){
|
andrew@0
|
659 //speedratio is speed of played relative to the recording
|
andrew@0
|
660
|
andrew@0
|
661 double index = relativeSpeedLikelihood.getRealTermsAsIndex(speedRatio);
|
andrew@0
|
662 // printf("\nindex of likelihood would be %f\n", index);
|
andrew@0
|
663 if (index >= 0 && index < relativeSpeedPrior.length){
|
andrew@0
|
664 //then we can do update
|
andrew@0
|
665
|
andrew@0
|
666 //set new likelihood
|
andrew@0
|
667 relativeSpeedLikelihood.zero();
|
andrew@0
|
668 relativeSpeedLikelihood.addConstant(speedLikelihoodNoise);
|
andrew@0
|
669
|
andrew@0
|
670 relativeSpeedLikelihood.addGaussianShape(index , 5, 0.5*matchFactor);
|
andrew@0
|
671
|
andrew@0
|
672
|
andrew@0
|
673 //copy posterior to prior
|
andrew@0
|
674 relativeSpeedPrior.copyFromDynamicVector(relativeSpeedPosterior);
|
andrew@0
|
675
|
andrew@0
|
676 //update
|
andrew@0
|
677 relativeSpeedPosterior.doProduct(relativeSpeedPrior, relativeSpeedLikelihood);
|
andrew@0
|
678
|
andrew@0
|
679 //normalise
|
andrew@0
|
680 relativeSpeedPosterior.renormalise();
|
andrew@0
|
681
|
andrew@0
|
682 relativeSpeedPosterior.getMaximum();
|
andrew@0
|
683 }//end if within range
|
andrew@0
|
684
|
andrew@0
|
685
|
andrew@0
|
686 }
|
andrew@0
|
687
|
andrew@0
|
688 */ |