search until finish found
-> todo computePathToNextPosition ohne durch hindernisse zu fahren