cleaned up a lot of code, trajectory lines and poses visible in Visualizer now