Visualize footstep successors

![rviz-8995-0](https://cloud.githubusercontent.com/assets/40454/4879527/4ead1920-632c-11e4-9580-721eeadadc15.gif)