diff --git a/makefiles/config_px4fmu-v2_test.mk b/makefiles/config_px4fmu-v2_test.mk
index d5a50cfae8..8623c0584b 100644
--- a/makefiles/config_px4fmu-v2_test.mk
+++ b/makefiles/config_px4fmu-v2_test.mk
@@ -32,6 +32,11 @@ MODULES		+= modules/systemlib
 MODULES		+= modules/systemlib/mixer
 MODULES		+= modules/uORB
 
+#
+# Libraries
+#
+LIBRARIES	+= lib/mathlib/CMSIS
+
 #
 # Transitional support - add commands from the NuttX export archive.
 #