Integration tests for Humanoid Path Planner