added trajectory visualizer for footsteps to joint configuration in rviz