Routing Algorithm

First draft of routing algorithm sd_taxi.get_cost coded. Not yet tested.