diff --git a/applications/SConscript b/applications/SConscript
index 9bb9aba..7db4e5f 100644
--- a/applications/SConscript
+++ b/applications/SConscript
@@ -3,7 +3,11 @@ import os
 
 cwd = GetCurrentDir()
 src = Glob('*.c')
-CPPPATH = [cwd]
+
+project_root = os.path.abspath(os.path.join(cwd, '..'))
+mavlink_path = os.path.join(project_root, 'lib', 'mavlink', 'v2.0')
+
+CPPPATH = [cwd, mavlink_path]
 
 group = DefineGroup('Applications', src, depend = [''], CPPPATH = CPPPATH)