Initial try at C++ rewrite of particle filter

publish output
added particle viewer
Rewrote C++ particle filter