From 6b836b833f98b35c40cebfac97083fc30b42fb5c Mon Sep 17 00:00:00 2001
From: shueja-personal <32416547+shueja-personal@users.noreply.github.com>
Date: Wed, 23 Aug 2023 15:00:42 -0700
Subject: [PATCH] fix debug prints again

---
 src/path/SwervePathBuilder.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/path/SwervePathBuilder.cpp b/src/path/SwervePathBuilder.cpp
index 54d1e68d..9ddeba1b 100644
--- a/src/path/SwervePathBuilder.cpp
+++ b/src/path/SwervePathBuilder.cpp
@@ -6,7 +6,7 @@
 #include <stdexcept>
 #include <vector>
 #include <cmath>
-#include <cstdio>
+#include <iostream>
 
 #include "optimization/TrajoptUtil.h"
 #include "trajopt/constraint/AngularVelocityConstraint.h"
@@ -75,7 +75,7 @@ void SwervePathBuilder::WptVelocityDirection(size_t idx, double angle) {
 }
 
 void SwervePathBuilder::WptVelocityMagnitude(size_t idx, double v) {
-  printf("Velocity from Cpp: %f", v);
+  std::cout << v << std::endl;
   if (std::abs(v) < 0.0001) {
     WptZeroVelocity(idx);
   } else {