示例#1
0
		if key == None:
			continue
		coordinates[key] = (val[0]-start[0],val[1]-start[1])
	return coordinates

init("/dev/tty.Fluke2-07EE-Fluke2")

# parser = Parser("CS3630_Lab2_Map1.csv")
# parser = Parser("CS3630_Lab2_Map2.csv")
parser = Parser("CS3630_Lab2_Map3.csv")

graph = Graph(parser.getVertexList1(),parser.getVertexList2())
print "Graph:"
graph.printGraph()

path = findPath(graph)
print "Path:"
print path

print "Coordinates:"
print parser.getCoordinates()

c = parser.getCoordinates()
relCoordinates = makeRel(c[path[0]], c)

print "Rel coordinates"
print relCoordinates
print path
nav = Navigator(path, relCoordinates)
nav.execute()