Fixed issue with starting position/orientation heuristic