diff --git a/Findbno055_imu_driver.cmake b/Findbno055_imu_driver.cmake
index 6391bf508102750af6f9fb86d29d895e1188b959..40517e13a1259534ca529be3a8addbf81dcca745 100644
--- a/Findbno055_imu_driver.cmake
+++ b/Findbno055_imu_driver.cmake
@@ -1,10 +1,20 @@
 #edit the following line to add the librarie's header files
-FIND_PATH(bno055_imu_driver_INCLUDE_DIR bno055_imu_driver.h bno055_imu_exceptions.h bno055_common.h /usr/include/iridrivers /usr/local/include/iridrivers)
+FIND_PATH(bno055_imu_driver_INCLUDE_DIR bno055_imu_driver.h bno055_imu_exceptions.h bno055_common.h bno055_imu_sim.h /usr/include/iridrivers /usr/local/include/iridrivers)
 
-FIND_LIBRARY(bno055_imu_driver_LIBRARY
+FIND_LIBRARY(bno055_imu_driver_LIBRARY_aux
     NAMES bno055_imu_driver
     PATHS /usr/lib /usr/local/lib /usr/local/lib/iridrivers) 
 
+FIND_LIBRARY(bno055_imu_sim_LIBRARY_aux
+    NAMES bno055_imu_sim
+    PATHS /usr/lib /usr/local/lib /usr/local/lib/iridrivers) 
+
+IF (bno055_imu_driver_LIBRARY_aux AND bno055_imu_sim_LIBRARY_aux)
+   SET(bno055_imu_driver_LIBRARY ${bno055_imu_driver_LIBRARY_aux} ${bno055_imu_sim_LIBRARY_aux})
+ELSE (bno055_imu_driver_LIBRARY_aux AND bno055_imu_sim_LIBRARY_aux)
+   MESSAGE(FATAL_ERROR "Could not find bn055_imu_driver ${bno055_imu_driver_LIBRARY_aux} or bno055_imu_sim ${bno055_imu_sim_LIBRARY_aux}")
+ENDIF (bno055_imu_driver_LIBRARY_aux AND bno055_imu_sim_LIBRARY_aux)
+
 IF (bno055_imu_driver_INCLUDE_DIR AND bno055_imu_driver_LIBRARY)
    SET(bno055_imu_driver_FOUND TRUE)
 ENDIF (bno055_imu_driver_INCLUDE_DIR AND bno055_imu_driver_LIBRARY)