Resolved path finder issue (last obstacle position was wrong)