Display footstep parameter on rviz

![footstep_overlay](https://cloud.githubusercontent.com/assets/40454/4923325/6f611fb0-6519-11e4-9168-fc2a6158b139.png)