annotate bayesianArraySrc/BayesianArrayStructure.cpp @ 7:33dedfe32893

kick, snare and bass windowed. Likelihoods in dedicated screen regions
author Andrew N Robertson <andrew.robertson@eecs.qmul.ac.uk>
date Thu, 02 Feb 2012 21:55:51 +0000
parents 746a5af43c02
children 572564b7cb85
rev   line source
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 */