QuickFusing

Use openmp for a particle filter with a build-in ekf as particle.