Added new ParticleFilterTrackerHist class instead of using ParticleFilterTracker. No template problems anymore due to removed unused functions (that forced me to keep several unwanted template instances). Replaced cloud2uvmatrix (problems with negative xyz -> uv...) by organisedNeighbor in HistogramCoherence to select points around particle. TODO: Query point seems to be wrong...