def get_route(self, destination):
destination = self.get_uid_from_map(destination)
current_pos = self.get_current();
dest_id = self.get_index_from_uid(destination)
curr_id = self.get_index_from_uid(current_pos)
print "dest id = ", dest_id
print "curr id = ", curr_id
from Route import Route
route = Route(curr_id, dest_id, [], [], [])
path = route.findRoute()
from Imu import IMU
imu = IMU()
print "imu reading = ", imu.get_heading()
from obstacle import Obstacle
o = Obstacle()
print "setting up motors..."
from Motor import Motor
motor = Motor(o)
motor.setup()
print "setting up navigation..."
from navigate import Navigate
navigator = Navigate(motor,imu)
navigator.set_direc(imu)
for x in range(0,len(path)-1):
#print (path[x],path[x+1])
#navigator.set_direc(imu)
navigator.navigate(path[x], path[x+1])
