Tests for Humanoid Path Planner platform