diff --git a/tool_path_planner/src/surface_walk_raster_generator.cpp b/tool_path_planner/src/surface_walk_raster_generator.cpp
index b1001451..d0810df8 100644
--- a/tool_path_planner/src/surface_walk_raster_generator.cpp
+++ b/tool_path_planner/src/surface_walk_raster_generator.cpp
@@ -1242,7 +1242,7 @@ vtkSmartPointer<vtkPolyData> SurfaceWalkRasterGenerator::createStartCurve()
     Eigen::Vector3d cut_dir(config_.cut_direction);
     if (!cut_dir.isApprox(Eigen::Vector3d::Zero()))
     {
-      max = cut_dir;
+      max = cut_dir.normalized() * max.norm();
     }
     else
     {