我在我的自动驾驶汽车项目中使用 python。因此,我研究了一种从 Dijkstra 算法返回值的算法。我给出算法(位置、目的地),它返回最短路径。然后我添加方向值。但我无法在某个时候增加这些值。这是我的代码:
coordinates = [['X',0,20],['B',15,20],['H',15,45],['G',20,45],['Y',20,55]]
dir = dijsktra(graph,'X','Y')
indexes = []
for i in range(len(dir)):
for j in range(len(coordinates)):
if dir[i] == coordinates[j][0]:
indexes.append(j)
for i in range(len(dir)-1):
if coordinates[indexes[i]][1] == coordinates[indexes[i+1]][1]:
turnons.append(['R',i+1])
elif coordinates[indexes[i]][2] == coordinates[indexes[i+1]][2]:
turnons.append(['L',i+1])
list_lenght = len(dir) + len(turnons)
for i in range(list_lenght):
for j in range(len(turnons)):
if turnons[j][1] == i:
dir.insert(i,turnons[j][0])
if turnons[j] != turnons[len(turnons)-1]:
print(turnons[j])
turnons[j + 1][1] += 1 // That's is the problem.
这是预期的输出: ['L', 1]['R', 3]['L', 5]['R', 7]
这就是我得到的: ['L', 1]['R', 3]['L', 4]
这里
L = 左
R = 正确
郎朗坤
相关分类