commit before taking object out of state vector
plotting multiple pfs. added mean shift/gmm
gmm initial experiments work
time to make things faster