Tools for Humanoid Path Planner