diff --git a/xs/src/libslic3r/MotionPlanner.cpp b/xs/src/libslic3r/MotionPlanner.cpp
index 9c76a3cd5..06b5f5e21 100644
--- a/xs/src/libslic3r/MotionPlanner.cpp
+++ b/xs/src/libslic3r/MotionPlanner.cpp
@@ -130,11 +130,8 @@ MotionPlanner::shortest_path(const Point &from, const Point &to, Polyline* polyl
     MotionPlannerGraph* graph = this->init_graph(island_idx);
     graph->shortest_path(graph->find_node(inner_from), graph->find_node(inner_to), polyline);
     
-    if (!from_is_inside)
-        polyline->points.insert(polyline->points.begin(), from);
-    
-    if (!to_is_inside)
-        polyline->points.push_back(to);
+    polyline->points.insert(polyline->points.begin(), from);
+    polyline->points.push_back(to);
     
     {
         // grow our environment slightly in order for simplify_by_visibility()