add assertions
This commit is contained in:
parent
47fbd2a2b5
commit
8429a1e792
@ -120,9 +120,25 @@ template <class DataFacadeT> class RoundTripPlugin final : public BasePlugin
|
|||||||
// => in_range = [0, 5]
|
// => in_range = [0, 5]
|
||||||
SCC_Component(std::vector<NodeID> in_component,
|
SCC_Component(std::vector<NodeID> in_component,
|
||||||
std::vector<size_t> in_range)
|
std::vector<size_t> in_range)
|
||||||
: component(in_component), range(in_range) {
|
: component(in_component),
|
||||||
range.push_back(in_component.size());
|
range(in_range) {
|
||||||
};
|
range.push_back(in_component.size());
|
||||||
|
BOOST_ASSERT_MSG(in_component.size() >= in_range.size(),
|
||||||
|
"scc component and its ranges do not match");
|
||||||
|
BOOST_ASSERT_MSG(*std::max_element(in_range.begin(), in_range.end()) < in_component.size(),
|
||||||
|
"scc component ranges are out of bound");
|
||||||
|
BOOST_ASSERT_MSG(*std::min_element(in_range.begin(), in_range.end()) >= 0,
|
||||||
|
"invalid scc component range");
|
||||||
|
BOOST_ASSERT_MSG([&in_range](){
|
||||||
|
for (std::size_t r = 0; r < in_range.size() - 1; ++r) {
|
||||||
|
if (in_range[r] > in_range[r+1]) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
}(),
|
||||||
|
"invalid component ranges");
|
||||||
|
};
|
||||||
|
|
||||||
// constructor to use when whole graph is one single scc
|
// constructor to use when whole graph is one single scc
|
||||||
SCC_Component(std::vector<NodeID> in_component)
|
SCC_Component(std::vector<NodeID> in_component)
|
||||||
@ -190,11 +206,15 @@ template <class DataFacadeT> class RoundTripPlugin final : public BasePlugin
|
|||||||
const auto from_node = *it;
|
const auto from_node = *it;
|
||||||
// if from_node is the last node, compute the route from the last to the first location
|
// if from_node is the last node, compute the route from the last to the first location
|
||||||
const auto to_node = std::next(it) != std::end(trip) ? *std::next(it) : *std::begin(trip);
|
const auto to_node = std::next(it) != std::end(trip) ? *std::next(it) : *std::begin(trip);
|
||||||
|
|
||||||
viapoint = PhantomNodes{phantom_node_vector[from_node][0], phantom_node_vector[to_node][0]};
|
viapoint = PhantomNodes{phantom_node_vector[from_node][0], phantom_node_vector[to_node][0]};
|
||||||
min_route.segment_end_coordinates.emplace_back(viapoint);
|
min_route.segment_end_coordinates.emplace_back(viapoint);
|
||||||
}
|
}
|
||||||
|
|
||||||
search_engine_ptr->shortest_path(min_route.segment_end_coordinates, route_parameters.uturns, min_route);
|
search_engine_ptr->shortest_path(min_route.segment_end_coordinates, route_parameters.uturns, min_route);
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(min_route.shortest_path_length < INVALID_EDGE_WEIGHT,
|
||||||
|
"unroutable route");
|
||||||
}
|
}
|
||||||
|
|
||||||
int HandleRequest(const RouteParameters &route_parameters,
|
int HandleRequest(const RouteParameters &route_parameters,
|
||||||
@ -240,8 +260,11 @@ template <class DataFacadeT> class RoundTripPlugin final : public BasePlugin
|
|||||||
route_result.reserve(scc.GetNumberOfComponents());
|
route_result.reserve(scc.GetNumberOfComponents());
|
||||||
TIMER_START(tsp);
|
TIMER_START(tsp);
|
||||||
//run TSP computation for every SCC
|
//run TSP computation for every SCC
|
||||||
for(auto k = 0; k < scc.GetNumberOfComponents(); ++k) {
|
for (std::size_t k = 0; k < scc.GetNumberOfComponents(); ++k) {
|
||||||
const auto component_size = scc.range[k+1] - scc.range[k];
|
const auto component_size = scc.range[k+1] - scc.range[k];
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(component_size >= 0,"invalid component size");
|
||||||
|
|
||||||
if (component_size > 1) {
|
if (component_size > 1) {
|
||||||
std::vector<NodeID> scc_route;
|
std::vector<NodeID> scc_route;
|
||||||
NodeIDIterator start = std::begin(scc.component) + scc.range[k];
|
NodeIDIterator start = std::begin(scc.component) + scc.range[k];
|
||||||
@ -266,6 +289,7 @@ template <class DataFacadeT> class RoundTripPlugin final : public BasePlugin
|
|||||||
route_result.push_back(scc_route);
|
route_result.push_back(scc_route);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// use this if output if debugging of route is needed:
|
||||||
SimpleLogger().Write() << "Route #"
|
SimpleLogger().Write() << "Route #"
|
||||||
<< k << ": "
|
<< k << ": "
|
||||||
<< [&scc_route](){
|
<< [&scc_route](){
|
||||||
@ -276,13 +300,14 @@ template <class DataFacadeT> class RoundTripPlugin final : public BasePlugin
|
|||||||
return s;
|
return s;
|
||||||
}();
|
}();
|
||||||
} else {
|
} else {
|
||||||
|
// if component only consists of one node, add it to the result routes
|
||||||
route_result.push_back({scc.component[scc.range[k]]});
|
route_result.push_back({scc.component[scc.range[k]]});
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// compute all round trip routes
|
// compute all round trip routes
|
||||||
std::vector<InternalRouteResult> comp_route (route_result.size());
|
std::vector<InternalRouteResult> comp_route (route_result.size());
|
||||||
for (auto r = 0; r < route_result.size(); ++r) {
|
for (std::size_t r = 0; r < route_result.size(); ++r) {
|
||||||
ComputeRoute(phantom_node_vector, route_parameters, route_result[r], comp_route[r]);
|
ComputeRoute(phantom_node_vector, route_parameters, route_result[r], comp_route[r]);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -293,7 +318,7 @@ template <class DataFacadeT> class RoundTripPlugin final : public BasePlugin
|
|||||||
|
|
||||||
// create a json object for every trip
|
// create a json object for every trip
|
||||||
osrm::json::Array trip;
|
osrm::json::Array trip;
|
||||||
for (auto i = 0; i < route_result.size(); ++i) {
|
for (std::size_t i = 0; i < route_result.size(); ++i) {
|
||||||
std::unique_ptr<BaseDescriptor<DataFacadeT>> descriptor;
|
std::unique_ptr<BaseDescriptor<DataFacadeT>> descriptor;
|
||||||
descriptor = osrm::make_unique<JSONDescriptor<DataFacadeT>>(facade);
|
descriptor = osrm::make_unique<JSONDescriptor<DataFacadeT>>(facade);
|
||||||
descriptor->SetConfig(route_parameters);
|
descriptor->SetConfig(route_parameters);
|
||||||
|
@ -52,6 +52,7 @@ namespace osrm
|
|||||||
namespace tsp
|
namespace tsp
|
||||||
{
|
{
|
||||||
|
|
||||||
|
// computes the distance of a given permutation
|
||||||
EdgeWeight ReturnDistance(const DistTableWrapper<EdgeWeight> & dist_table,
|
EdgeWeight ReturnDistance(const DistTableWrapper<EdgeWeight> & dist_table,
|
||||||
const std::vector<NodeID> & location_order,
|
const std::vector<NodeID> & location_order,
|
||||||
const EdgeWeight min_route_dist,
|
const EdgeWeight min_route_dist,
|
||||||
@ -62,9 +63,13 @@ EdgeWeight ReturnDistance(const DistTableWrapper<EdgeWeight> & dist_table,
|
|||||||
route_dist += dist_table(location_order[i], location_order[(i+1) % component_size]);
|
route_dist += dist_table(location_order[i], location_order[(i+1) % component_size]);
|
||||||
++i;
|
++i;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(route_dist != INVALID_EDGE_WEIGHT, "invalid route found");
|
||||||
|
|
||||||
return route_dist;
|
return route_dist;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// computes the route by computing all permutations and selecting the shortest
|
||||||
template <typename NodeIDIterator>
|
template <typename NodeIDIterator>
|
||||||
std::vector<NodeID> BruteForceTSP(const NodeIDIterator start,
|
std::vector<NodeID> BruteForceTSP(const NodeIDIterator start,
|
||||||
const NodeIDIterator end,
|
const NodeIDIterator end,
|
||||||
@ -79,6 +84,10 @@ std::vector<NodeID> BruteForceTSP(const NodeIDIterator start,
|
|||||||
EdgeWeight min_route_dist = INVALID_EDGE_WEIGHT;
|
EdgeWeight min_route_dist = INVALID_EDGE_WEIGHT;
|
||||||
|
|
||||||
// check length of all possible permutation of the component ids
|
// check length of all possible permutation of the component ids
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(*(std::max_element(std::begin(perm), std::end(perm))) < number_of_locations, "invalid node id");
|
||||||
|
BOOST_ASSERT_MSG(*(std::min_element(std::begin(perm), std::end(perm))) >= 0, "invalid node id");
|
||||||
|
|
||||||
do {
|
do {
|
||||||
const auto new_distance = ReturnDistance(dist_table, perm, min_route_dist, component_size);
|
const auto new_distance = ReturnDistance(dist_table, perm, min_route_dist, component_size);
|
||||||
if (new_distance <= min_route_dist) {
|
if (new_distance <= min_route_dist) {
|
||||||
|
@ -73,12 +73,21 @@ std::pair<EdgeWeight, NodeIDIter> GetShortestRoundTrip(const NodeID new_loc,
|
|||||||
const auto dist_to = dist_table(new_loc, *to_node);
|
const auto dist_to = dist_table(new_loc, *to_node);
|
||||||
const auto trip_dist = dist_from + dist_to - dist_table(*from_node, *to_node);;
|
const auto trip_dist = dist_from + dist_to - dist_table(*from_node, *to_node);;
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(dist_from != INVALID_EDGE_WEIGHT,
|
||||||
|
"distance has invalid edge weight");
|
||||||
|
BOOST_ASSERT_MSG(dist_to != INVALID_EDGE_WEIGHT,
|
||||||
|
"distance has invalid edge weight");
|
||||||
|
BOOST_ASSERT_MSG(trip_dist >= 0,
|
||||||
|
"previous trip was not minimal. something's wrong");
|
||||||
|
|
||||||
// from all possible insertions to the current trip, choose the shortest of all insertions
|
// from all possible insertions to the current trip, choose the shortest of all insertions
|
||||||
if (trip_dist < min_trip_distance) {
|
if (trip_dist < min_trip_distance) {
|
||||||
min_trip_distance = trip_dist;
|
min_trip_distance = trip_dist;
|
||||||
next_insert_point_candidate = to_node;
|
next_insert_point_candidate = to_node;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
BOOST_ASSERT_MSG(min_trip_distance != INVALID_EDGE_WEIGHT,
|
||||||
|
"trip has invalid edge weight");
|
||||||
|
|
||||||
return std::make_pair(min_trip_distance, next_insert_point_candidate);
|
return std::make_pair(min_trip_distance, next_insert_point_candidate);
|
||||||
}
|
}
|
||||||
@ -86,12 +95,15 @@ std::pair<EdgeWeight, NodeIDIter> GetShortestRoundTrip(const NodeID new_loc,
|
|||||||
template <typename NodeIDIterator>
|
template <typename NodeIDIterator>
|
||||||
// given two initial start nodes, find a roundtrip route using the farthest insertion algorithm
|
// given two initial start nodes, find a roundtrip route using the farthest insertion algorithm
|
||||||
std::vector<NodeID> FindRoute(const std::size_t & number_of_locations,
|
std::vector<NodeID> FindRoute(const std::size_t & number_of_locations,
|
||||||
const std::size_t & size_of_component,
|
const std::size_t & component_size,
|
||||||
const NodeIDIterator & start,
|
const NodeIDIterator & start,
|
||||||
const NodeIDIterator & end,
|
const NodeIDIterator & end,
|
||||||
const DistTableWrapper<EdgeWeight> & dist_table,
|
const DistTableWrapper<EdgeWeight> & dist_table,
|
||||||
const NodeID & start1,
|
const NodeID & start1,
|
||||||
const NodeID & start2) {
|
const NodeID & start2) {
|
||||||
|
BOOST_ASSERT_MSG(number_of_locations >= component_size,
|
||||||
|
"component size bigger than total number of locations");
|
||||||
|
|
||||||
std::vector<NodeID> route;
|
std::vector<NodeID> route;
|
||||||
route.reserve(number_of_locations);
|
route.reserve(number_of_locations);
|
||||||
|
|
||||||
@ -104,7 +116,7 @@ std::vector<NodeID> FindRoute(const std::size_t & number_of_locations,
|
|||||||
route.push_back(start2);
|
route.push_back(start2);
|
||||||
|
|
||||||
// add all other nodes missing (two nodes are already in the initial start trip)
|
// add all other nodes missing (two nodes are already in the initial start trip)
|
||||||
for (std::size_t j = 2; j < size_of_component; ++j) {
|
for (std::size_t j = 2; j < component_size; ++j) {
|
||||||
|
|
||||||
auto farthest_distance = 0;
|
auto farthest_distance = 0;
|
||||||
auto next_node = -1;
|
auto next_node = -1;
|
||||||
@ -116,6 +128,9 @@ std::vector<NodeID> FindRoute(const std::size_t & number_of_locations,
|
|||||||
if (!visited[*i]) {
|
if (!visited[*i]) {
|
||||||
auto insert_candidate = GetShortestRoundTrip(*i, dist_table, number_of_locations, route);
|
auto insert_candidate = GetShortestRoundTrip(*i, dist_table, number_of_locations, route);
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(insert_candidate.first != INVALID_EDGE_WEIGHT,
|
||||||
|
"shortest round trip is invalid");
|
||||||
|
|
||||||
// add the location to the current trip such that it results in the shortest total tour
|
// add the location to the current trip such that it results in the shortest total tour
|
||||||
if (insert_candidate.first >= farthest_distance) {
|
if (insert_candidate.first >= farthest_distance) {
|
||||||
farthest_distance = insert_candidate.first;
|
farthest_distance = insert_candidate.first;
|
||||||
@ -125,6 +140,8 @@ std::vector<NodeID> FindRoute(const std::size_t & number_of_locations,
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(next_node >= 0, "next node to visit is invalid");
|
||||||
|
|
||||||
// mark as visited and insert node
|
// mark as visited and insert node
|
||||||
visited[next_node] = true;
|
visited[next_node] = true;
|
||||||
route.insert(next_insert_point, next_node);
|
route.insert(next_insert_point, next_node);
|
||||||
@ -169,7 +186,8 @@ std::vector<NodeID> FarthestInsertionTSP(const NodeIDIterator & start,
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
BOOST_ASSERT_MSG(max_from < number_of_locations && max_from >= 0, "start node");
|
||||||
|
BOOST_ASSERT_MSG(max_to < number_of_locations && max_to >= 0, "start node");
|
||||||
return FindRoute(number_of_locations, component_size, start, end, dist_table, max_from, max_to);
|
return FindRoute(number_of_locations, component_size, start, end, dist_table, max_from, max_to);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -84,7 +84,7 @@ std::vector<NodeID> NearestNeighbourTSP(const NodeIDIterator & start,
|
|||||||
|
|
||||||
// 3. REPEAT FOR EVERY UNVISITED NODE
|
// 3. REPEAT FOR EVERY UNVISITED NODE
|
||||||
EdgeWeight trip_dist = 0;
|
EdgeWeight trip_dist = 0;
|
||||||
for(auto via_point = 1; via_point < component_size; ++via_point)
|
for(std::size_t via_point = 1; via_point < component_size; ++via_point)
|
||||||
{
|
{
|
||||||
EdgeWeight min_dist = INVALID_EDGE_WEIGHT;
|
EdgeWeight min_dist = INVALID_EDGE_WEIGHT;
|
||||||
NodeID min_id = SPECIAL_NODEID;
|
NodeID min_id = SPECIAL_NODEID;
|
||||||
@ -92,12 +92,16 @@ std::vector<NodeID> NearestNeighbourTSP(const NodeIDIterator & start,
|
|||||||
// 2. FIND NEAREST NEIGHBOUR
|
// 2. FIND NEAREST NEIGHBOUR
|
||||||
for (auto next = start; next != end; ++next) {
|
for (auto next = start; next != end; ++next) {
|
||||||
auto curr_dist = dist_table(curr_node, *next);
|
auto curr_dist = dist_table(curr_node, *next);
|
||||||
|
BOOST_ASSERT_MSG(curr_dist != INVALID_EDGE_WEIGHT, "invalid distance found");
|
||||||
if(!visited[*next] &&
|
if(!visited[*next] &&
|
||||||
curr_dist < min_dist) {
|
curr_dist < min_dist) {
|
||||||
min_dist = curr_dist;
|
min_dist = curr_dist;
|
||||||
min_id = *next;
|
min_id = *next;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
BOOST_ASSERT_MSG(min_id != SPECIAL_NODEID, "no next node found");
|
||||||
|
|
||||||
visited[min_id] = true;
|
visited[min_id] = true;
|
||||||
curr_route.push_back(min_id);
|
curr_route.push_back(min_id);
|
||||||
trip_dist += min_dist;
|
trip_dist += min_dist;
|
||||||
|
@ -43,7 +43,7 @@ public:
|
|||||||
DistTableWrapper(std::vector<T> table, std::size_t number_of_nodes)
|
DistTableWrapper(std::vector<T> table, std::size_t number_of_nodes)
|
||||||
: table_(std::move(table)), number_of_nodes_(number_of_nodes) {
|
: table_(std::move(table)), number_of_nodes_(number_of_nodes) {
|
||||||
BOOST_ASSERT_MSG(table.size() == 0, "table is empty");
|
BOOST_ASSERT_MSG(table.size() == 0, "table is empty");
|
||||||
BOOST_ASSERT_MSG(number_of_nodes_ * number_of_nodes_ < table_, "number_of_nodes_ is invalid");
|
BOOST_ASSERT_MSG(number_of_nodes_ * number_of_nodes_ <= table_.size(), "number_of_nodes_ is invalid");
|
||||||
};
|
};
|
||||||
|
|
||||||
std::size_t GetNumberOfNodes() const {
|
std::size_t GetNumberOfNodes() const {
|
||||||
@ -57,8 +57,11 @@ public:
|
|||||||
EdgeWeight operator() (NodeID from, NodeID to) const {
|
EdgeWeight operator() (NodeID from, NodeID to) const {
|
||||||
BOOST_ASSERT_MSG(from < number_of_nodes_, "from ID is out of bound");
|
BOOST_ASSERT_MSG(from < number_of_nodes_, "from ID is out of bound");
|
||||||
BOOST_ASSERT_MSG(to < number_of_nodes_, "to ID is out of bound");
|
BOOST_ASSERT_MSG(to < number_of_nodes_, "to ID is out of bound");
|
||||||
|
|
||||||
const auto index = from * number_of_nodes_ + to;
|
const auto index = from * number_of_nodes_ + to;
|
||||||
BOOST_ASSERT_MSG(index < table_size(), "index is out of bound");
|
|
||||||
|
BOOST_ASSERT_MSG(index < table_.size(), "index is out of bound");
|
||||||
|
|
||||||
return table_[index];
|
return table_[index];
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user