Display footstep parameter on rviz