Debugged many compilation issues with the belief-state predictor and related infrastructure. Now, that compiles. Ready to write online filtering code. Added mutexes in predicted traj.