Add temp print statement

Author: sea-bass

cpp/CMakeLists.txt

@@ -30,7 +30,7 @@ set(PYBIND11_PYTHON_VERSION "${PYTHON_VERSION}")
 include(CMakePrintHelpers)
 
 find_package (Threads)
-find_package (Eigen3 3.4 REQUIRED)
+find_package (Eigen3 REQUIRED)
 message(STATUS "Found Eigen version ${EIGEN3_VERSION_STRING}")
 
 list(APPEND CMAKE_MODULE_PATH "${PROJECT_SOURCE_DIR}/cmake")

cpp/src/toppra/geometric_path/piecewise_poly_path.cpp

@@ -210,6 +210,9 @@ PiecewisePolyPath::PiecewisePolyPath(const Matrices & coefficients,
   computeDerivativesCoefficients();
 }
 Bound PiecewisePolyPath::pathInterval() const {
+  std::cout << "BREAKPOINTS FOR PATH INTERVAL LENGTH " << m_breakpoints.size() << std::endl;
+  std::cout << "FRONT: " << breakpoints.front() << std::endl;
+  std::cout << "BACK: " << breakpoints.back() << std::endl;
   return Bound{m_breakpoints.front(), m_breakpoints.back()};
 };