Fix Localization -> particle_filter headers

bitbots_lowlevel/bitbots_ros_control/include/bitbots_ros_control/hardware_interface.hpp

@@ -12,11 +12,11 @@ class HardwareInterface {
  public:
   virtual bool init() = 0;
 
-  virtual void read(const rclcpp::Time &t, const rclcpp::Duration &dt){};
+  virtual void read(const rclcpp::Time &t, const rclcpp::Duration &dt) {};
 
-  virtual void write(const rclcpp::Time &t, const rclcpp::Duration &dt){};
+  virtual void write(const rclcpp::Time &t, const rclcpp::Duration &dt) {};
 
-  virtual void restoreAfterPowerCycle(){};
+  virtual void restoreAfterPowerCycle() {};
 
   virtual ~HardwareInterface(){};
 };

bitbots_lowlevel/bitbots_ros_control/src/pressure_converter.cpp

@@ -76,8 +76,7 @@ PressureConverter::PressureConverter(rclcpp::Node::SharedPtr nh, char side) {
   }
   for (int i = 0; i < 4; i++) {
     std::stringstream single_wrench_frame;
-    single_wrench_frame << side << "_"
-                        << "cleat_" << wrench_topics[i];
+    single_wrench_frame << side << "_" << "cleat_" << wrench_topics[i];
     wrench_frames_.push_back(single_wrench_frame.str());
   }
 

bitbots_navigation/bitbots_localization/include/bitbots_localization/MotionModel.hpp

@@ -5,14 +5,13 @@
 #ifndef BITBOTS_LOCALIZATION_MOTIONMODEL_H
 #define BITBOTS_LOCALIZATION_MOTIONMODEL_H
 
-#include <particle_filter/CRandomNumberGenerator.h>
-#include <particle_filter/MovementModel.h>
-
 #include <bitbots_localization/RobotState.hpp>
 #include <bitbots_localization/tools.hpp>
 #include <cstdlib>
 #include <geometry_msgs/msg/vector3.hpp>
 #include <memory>
+#include <particle_filter/CRandomNumberGenerator.hpp>
+#include <particle_filter/MovementModel.hpp>
 
 namespace bitbots_localization {
 /**
@@ -61,5 +60,5 @@ class RobotMotionModel : public particle_filter::MovementModel<RobotState> {
 
   double sample(double b) const;
 };
-};      // namespace bitbots_localization
+};  // namespace bitbots_localization
 #endif  // BITBOTS_LOCALIZATION_MOTIONMODEL_H

bitbots_navigation/bitbots_localization/include/bitbots_localization/ObservationModel.hpp

@@ -5,12 +5,11 @@
 #ifndef BITBOTS_LOCALIZATION_OBSERVATIONMODEL_H
 #define BITBOTS_LOCALIZATION_OBSERVATIONMODEL_H
 
-#include <particle_filter/ParticleFilter.h>
-
 #include <bitbots_localization/RobotState.hpp>
 #include <bitbots_localization/map.hpp>
 #include <bitbots_localization/tools.hpp>
 #include <localization_parameters.hpp>
+#include <particle_filter/ParticleFilter.hpp>
 #include <sensor_msgs/msg/point_cloud2.hpp>
 #include <sensor_msgs/point_cloud2_iterator.hpp>
 #include <soccer_vision_3d_msgs/msg/field_boundary.hpp>

bitbots_navigation/bitbots_localization/include/bitbots_localization/Resampling.hpp

@@ -5,10 +5,9 @@
 #ifndef IMPORTANCERESAMPLINGWE_H
 #define IMPORTANCERESAMPLINGWE_H
 
-#include <particle_filter/CRandomNumberGenerator.h>
-#include <particle_filter/ImportanceResampling.h>
-
 #include <cassert>
+#include <particle_filter/CRandomNumberGenerator.hpp>
+#include <particle_filter/ImportanceResampling.hpp>
 
 namespace bitbots_localization {
 // ImportanceResampling with explorers
@@ -97,5 +96,5 @@ void ImportanceResamplingWE<StateType>::resample(const ParticleList &sourceList,
 // template <class StateType>
 // void ParticleFilter<StateType>::drawAllFromDistribution(const
 // std::shared_ptr<StateDistribution<StateType>>& distribution) {
-};      // namespace bitbots_localization
+};  // namespace bitbots_localization
 #endif  // IMPORTANCERESAMPLINGWE_H

bitbots_navigation/bitbots_localization/include/bitbots_localization/RobotState.hpp

@@ -5,12 +5,12 @@
 #ifndef BITBOTS_LOCALIZATION_ROBOTSTATE_H
 #define BITBOTS_LOCALIZATION_ROBOTSTATE_H
 
-#include <particle_filter/ParticleFilter.h>
 #include <tf2/LinearMath/Quaternion.h>
 
 #include <Eigen/Core>
 #include <bitbots_localization/tools.hpp>
 #include <cmath>
+#include <particle_filter/ParticleFilter.hpp>
 #include <vector>
 
 namespace bitbots_localization {

bitbots_navigation/bitbots_localization/include/bitbots_localization/StateDistribution.hpp

@@ -5,10 +5,9 @@
 #ifndef BITBOTS_LOCALIZATION_STATEDISTRIBUTION_H
 #define BITBOTS_LOCALIZATION_STATEDISTRIBUTION_H
 
-#include <particle_filter/CRandomNumberGenerator.h>
-#include <particle_filter/StateDistribution.h>
-
 #include <bitbots_localization/RobotState.hpp>
+#include <particle_filter/CRandomNumberGenerator.hpp>
+#include <particle_filter/StateDistribution.hpp>
 #include <rclcpp/rclcpp.hpp>
 #include <utility>
 

bitbots_navigation/bitbots_localization/include/bitbots_localization/localization.hpp

@@ -6,9 +6,6 @@
 #define BITBOTS_LOCALIZATION_LOCALIZATION_H
 
 #include <message_filters/subscriber.h>
-#include <particle_filter/CRandomNumberGenerator.h>
-#include <particle_filter/ParticleFilter.h>
-#include <particle_filter/gaussian_mixture_model.h>
 #include <tf2/LinearMath/Quaternion.h>
 #include <tf2/LinearMath/Transform.h>
 #include <tf2/convert.h>
@@ -45,6 +42,9 @@
 #include <iterator>
 #include <localization_parameters.hpp>
 #include <memory>
+#include <particle_filter/CRandomNumberGenerator.hpp>
+#include <particle_filter/ParticleFilter.hpp>
+#include <particle_filter/gaussian_mixture_model.hpp>
 #include <rclcpp/rclcpp.hpp>
 #include <sensor_msgs/msg/camera_info.hpp>
 #include <sensor_msgs/msg/point_cloud2.hpp>

bitbots_navigation/bitbots_localization/include/bitbots_localization/map.hpp

@@ -53,5 +53,5 @@ class Map {
  private:
   double out_of_map_value_;
 };
-};      // namespace bitbots_localization
+};  // namespace bitbots_localization
 #endif  // BITBOTS_LOCALIZATION_MAP_H