added all poses to Trajectory class. Might work. might not