+else()
+ message("Feature J1939 disabled")
+endif()
+
+# Activate ISO TP
+# Need module in kernel
+# --------------
+
+# Default to off
+set(WITH_FEATURE_ISOTP OFF CACHE BOOL "")
+
+execute_process(COMMAND ls $ENV{PKG_CONFIG_SYSROOT_DIR}/usr/include/linux/can/isotp.h RESULT_VARIABLE result2 OUTPUT_QUIET ERROR_QUIET)
+
+if(result2)
+ message("ISO TP header not detected!")
+ # Over-ride cached value
+ set(WITH_FEATURE_ISOTP OFF)
+else()
+ message("ISO TP header detected")
+ # Check cache to allow over-ride
+ set(WITH_FEATURE_ISOTP ON CACHE BOOL "")