Fix errors from new cpplint.py (#7105)

wpimath/src/main/native/cpp/MathShared.cpp

@@ -4,6 +4,9 @@
 
 #include "wpimath/MathShared.h"
 
+#include <memory>
+#include <utility>
+
 #include <wpi/mutex.h>
 #include <wpi/timestamp.h>
 

wpimath/src/main/native/cpp/controller/ArmFeedforward.cpp

@@ -4,6 +4,7 @@
 
 #include "frc/controller/ArmFeedforward.h"
 
+#include <algorithm>
 #include <limits>
 
 #include <sleipnir/autodiff/Gradient.hpp>

wpimath/src/main/native/cpp/estimator/DifferentialDrivePoseEstimator.cpp

@@ -4,6 +4,8 @@
 
 #include "frc/estimator/DifferentialDrivePoseEstimator.h"
 
+#include <vector>
+
 using namespace frc;
 
 DifferentialDrivePoseEstimator::DifferentialDrivePoseEstimator(

wpimath/src/main/native/cpp/geometry/Pose3d.cpp

@@ -5,6 +5,7 @@
 #include "frc/geometry/Pose3d.h"
 
 #include <cmath>
+#include <utility>
 
 #include <Eigen/Core>
 #include <wpi/json.h>

wpimath/src/main/native/cpp/geometry/Rotation3d.cpp

@@ -6,6 +6,7 @@
 
 #include <cmath>
 #include <numbers>
+#include <string>
 
 #include <Eigen/Core>
 #include <Eigen/LU>

wpimath/src/main/native/cpp/geometry/Transform3d.cpp

@@ -4,6 +4,8 @@
 
 #include "frc/geometry/Transform3d.h"
 
+#include <utility>
+
 #include "frc/geometry/Pose3d.h"
 
 using namespace frc;

wpimath/src/main/native/cpp/geometry/Translation2d.cpp

@@ -4,6 +4,8 @@
 
 #include "frc/geometry/Translation2d.h"
 
+#include <algorithm>
+
 #include <wpi/json.h>
 
 #include "units/math.h"

wpimath/src/main/native/cpp/jni/TrajectoryUtilJNI.cpp

@@ -5,6 +5,7 @@
 #include <jni.h>
 
 #include <exception>
+#include <vector>
 
 #include <wpi/jni_util.h>
 

wpimath/src/main/native/cpp/spline/SplineHelper.cpp

@@ -5,6 +5,7 @@
 #include "frc/spline/SplineHelper.h"
 
 #include <cstddef>
+#include <vector>
 
 using namespace frc;
 

wpimath/src/main/native/cpp/trajectory/Trajectory.cpp

@@ -6,6 +6,7 @@
 
 #include <algorithm>
 #include <stdexcept>
+#include <vector>
 
 #include <wpi/MathExtras.h>
 #include <wpi/json.h>

wpimath/src/main/native/cpp/trajectory/TrajectoryGenerator.cpp

@@ -5,6 +5,7 @@
 #include "frc/trajectory/TrajectoryGenerator.h"
 
 #include <utility>
+#include <vector>
 
 #include <wpi/print.h>
 

wpimath/src/main/native/cpp/trajectory/TrajectoryParameterizer.cpp

@@ -28,6 +28,8 @@
 
 #include "frc/trajectory/TrajectoryParameterizer.h"
 
+#include <vector>
+
 #include <fmt/format.h>
 
 #include "units/math.h"

wpimath/src/main/native/cpp/trajectory/TrajectoryUtil.cpp

@@ -4,6 +4,7 @@
 
 #include "frc/trajectory/TrajectoryUtil.h"
 
+#include <string>
 #include <system_error>
 
 #include <fmt/format.h>

wpimath/src/main/native/cpp/trajectory/constraint/DifferentialDriveKinematicsConstraint.cpp

@@ -4,6 +4,8 @@
 
 #include "frc/trajectory/constraint/DifferentialDriveKinematicsConstraint.h"
 
+#include <utility>
+
 using namespace frc;
 
 DifferentialDriveKinematicsConstraint::DifferentialDriveKinematicsConstraint(

wpimath/src/main/native/cpp/trajectory/constraint/DifferentialDriveVoltageConstraint.cpp

@@ -6,6 +6,7 @@
 
 #include <algorithm>
 #include <limits>
+#include <utility>
 
 #include <wpi/MathExtras.h>
 

wpimath/src/main/native/cpp/trajectory/proto/TrajectoryProto.cpp

@@ -4,6 +4,8 @@
 
 #include "frc/trajectory/proto/TrajectoryProto.h"
 
+#include <vector>
+
 #include <wpi/ProtoHelper.h>
 
 #include "trajectory.pb.h"

wpimath/src/main/native/thirdparty/sleipnir/include/sleipnir/util/Print.hpp

@@ -2,6 +2,7 @@
 
 #pragma once
 
+#include <cstdio>
 #include <system_error>
 #include <utility>
 

wpimath/src/main/native/thirdparty/sleipnir/src/optimization/solver/InteriorPoint.cpp

@@ -240,11 +240,16 @@ void InteriorPoint(std::span<Variable> decisionVariables,
   // Error estimate
   double E_0 = std::numeric_limits<double>::infinity();
 
-  iterationsStartTime = std::chrono::system_clock::now();
+  if (config.diagnostics) {
+    iterationsStartTime = std::chrono::system_clock::now();
+  }
 
   while (E_0 > config.tolerance &&
          acceptableIterCounter < config.maxAcceptableIterations) {
-    auto innerIterStartTime = std::chrono::system_clock::now();
+    std::chrono::system_clock::time_point innerIterStartTime;
+    if (config.diagnostics) {
+      innerIterStartTime = std::chrono::system_clock::now();
+    }
 
     // Check for local equality constraint infeasibility
     if (IsEqualityLocallyInfeasible(A_e, c_e)) {