diff --git a/libraries/AP_Math/AP_Math.h b/libraries/AP_Math/AP_Math.h
index b7b058f8ad..e7b1e1c392 100644
--- a/libraries/AP_Math/AP_Math.h
+++ b/libraries/AP_Math/AP_Math.h
@@ -185,10 +185,10 @@ float sq(const T first, const Params... parameters)
  * Variadic template for calculating the norm (pythagoras) of a vector of any
  * dimension.
  */
-template<class T, class... Params>
-float norm(const T first, const Params... parameters)
+template<class T, class U, class... Params>
+float norm(const T first, const U second, const Params... parameters)
 {
-    return sqrt(static_cast<float>(sq(first, parameters...)));
+    return sqrtf(sq(first, second, parameters...));
 }
 
 template<typename A, typename B>