Skip to content
This repository has been archived by the owner on Jul 8, 2024. It is now read-only.

Commit

Permalink
format
Browse files Browse the repository at this point in the history
  • Loading branch information
bruingineer committed Jun 25, 2024
1 parent f8598cf commit adb2f53
Showing 1 changed file with 3 additions and 3 deletions.
6 changes: 3 additions & 3 deletions src/path/SwervePathBuilder.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -399,8 +399,8 @@ SwervePathBuilder::CalculateWaypointStatesWithControlIntervals() const {
static_cast<double>(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());
Expand Down Expand Up @@ -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(),
Expand Down

0 comments on commit adb2f53

Please sign in to comment.