diff --git a/src/path/SwervePathBuilder.cpp b/src/path/SwervePathBuilder.cpp index 29528b65..f5f4af92 100644 --- a/src/path/SwervePathBuilder.cpp +++ b/src/path/SwervePathBuilder.cpp @@ -399,8 +399,8 @@ SwervePathBuilder::CalculateWaypointStatesWithControlIntervals() const { static_cast(sampleIdx) / samples; const auto state = trajs.at(trajIdx).Sample(t); waypoint_states.at(trajIdx + 1).push_back(state); - // std::printf("%zd, x: %f, y: %f, t: %f\n", - // sampleIdx, state.pose.X().value(), + // std::printf("%zd, x: %f, y: %f, t: %f\n", + // sampleIdx, state.pose.X().value(), // state.pose.Y().value(), t.value()); } std::printf(" size: %zd\n", waypoint_states.at(trajIdx + 1).size()); @@ -435,7 +435,7 @@ SwervePathBuilder::CalculateSplineInitialGuessWithKinematicsAndConstraints() dt = traj.at(1).t - traj.front().t; } for (const auto& point : traj) { - // printf("point{%f, %f, %f, %f, %f}\n", + // std::printf("point{%f, %f, %f, %f, %f}\n", // point.pose.X().value(), // point.pose.Y().value(), // point.pose.Rotation().Cos(),