diff --git a/src/lib/motion_planning/HeadingSmoothing.cpp b/src/lib/motion_planning/HeadingSmoothing.cpp
index 50671f6f0f..037eeb701b 100644
--- a/src/lib/motion_planning/HeadingSmoothing.cpp
+++ b/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);
diff --git a/src/lib/motion_planning/HeadingSmoothing.hpp b/src/lib/motion_planning/HeadingSmoothing.hpp
index 30ef7c6805..5fdb4dde36 100644
--- a/src/lib/motion_planning/HeadingSmoothing.hpp
+++ b/src/lib/motion_planning/HeadingSmoothing.hpp
@@ -54,7 +54,7 @@
 class HeadingSmoothing
 {
 public:
-	HeadingSmoothing() = default;
+	HeadingSmoothing();
 	~HeadingSmoothing() = default;
 
 	/** @param max_heading_rate [rad/s] */