HeadingSmoothing: set correct maximum heading

The velocity smoothing library constrains the maximum vellocity.
I set the default constraint to 0 to find these exact issues.
The heading smoothing did not initialize the maximum velocity
which in this use case is the maximum heading.
So heading was always constrained to 0 -> north until this change.

src/lib/motion_planning/HeadingSmoothing.cpp

@@ -33,6 +33,11 @@
 
 #include "HeadingSmoothing.hpp"
 
+HeadingSmoothing::HeadingSmoothing()
+{
+	_velocity_smoothing.setMaxVel(M_PI_F); // smoothed "velocity" is heading [-pi, pi]
+}
+
 void HeadingSmoothing::reset(const float heading, const float heading_rate)
 {
 	const float wrapped_heading = matrix::wrap_pi(heading);

src/lib/motion_planning/HeadingSmoothing.hpp

@@ -54,7 +54,7 @@
 class HeadingSmoothing
 {
 public:
-	HeadingSmoothing() = default;
+	HeadingSmoothing();
 	~HeadingSmoothing() = default;
 
 	/** @param max_heading_rate [rad/s] */