path: fix issue about position
Path: compute path better
heuristic: fix ball start position