https://github.com/utra-robosoccer/soccerbot/blob/master/soccer_control/soccer_pycontrol/src/soccer_pycontrol/walk_engine/foot_step_planner.py https://wiki.ros.org/visualization_msgs
