cmake_minimum_required(VERSION 3.3 FATAL_ERROR)

project(basler_blaze LANGUAGES CXX)

set(CMAKE_CXX_STANDARD 14)
set(CMAKE_CXX_STANDARD_REQUIRED ON)

## Find catkin macros and libraries.
find_package(catkin REQUIRED COMPONENTS
  roscpp
  sensor_msgs
  camera_info_manager
  cv_bridge
  pcl_ros
  message_generation
)


# Locate the cmake find module for pylon ...
find_path(pylon_cmake Findpylon.cmake 
    HINTS "$ENV{PYLON_DEV_DIR}/lib/cmake"
          "$ENV{ProgramFiles}/Basler/pylon 6/Development/lib/cmake"
          "$ENV{ProgramFiles}/Basler/pylon 5/Development/lib/cmake"
          "/opt/pylon/lib/cmake"
        )
if (NOT pylon_cmake )
  message(FATAL_ERROR 
  "Findpylon.cmake module not found. Either set the PYLON_DEV_DIR"
      "environment variable or the pylon_ROOT_DIR CMake variable to the location "
      "the Basler pylon SDK is installed in.")
endif()
# ... and extend the cmake module path accordingly.
list(APPEND CMAKE_MODULE_PATH ${pylon_cmake})

find_package(pylon 6.2 REQUIRED)

## Generate services in the 'srv' folder.
add_service_files(
  FILES
  SetBlazeParameter.srv
  GetBlazeParameter.srv
  SetBlazeDataStreamParameter.srv
  GetBlazeDataStreamParameter.srv
  ExecuteCommand.srv
)

## Generate messages and services with any dependencies listed here.
generate_messages(
  DEPENDENCIES
  std_msgs
)

## catkin-specific configuration ##
catkin_package(
  CATKIN_DEPENDS roscpp sensor_msgs camera_info_manager cv_bridge pcl_ros message_generation
)

## Build ##
include_directories(
  ${catkin_INCLUDE_DIRS}
)

add_executable(${PROJECT_NAME}_node src/basler_blaze_node.cpp)

add_dependencies(${PROJECT_NAME}_node
  ${${PROJECT_NAME}_EXPORTED_TARGETS}
  ${catkin_EXPORTED_TARGETS}
)

target_link_libraries(${PROJECT_NAME}_node
  ${catkin_LIBRARIES}
  pylon::pylon
)

add_dependencies(${PROJECT_NAME}_node ${PROJECT_NAME}_gencpp)

#############
## Install ##
#############

install(TARGETS ${PROJECT_NAME}_node
        RUNTIME DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}
)

install(DIRECTORY launch
        DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}
        )

#############
## Testing ##
#############

if(CATKIN_ENABLE_TESTING)
  find_package(rostest REQUIRED)
  add_rostest_gtest(basler_blaze_utest_node test/launch/utest.test test/utest.cpp)
  target_link_libraries(basler_blaze_utest_node ${catkin_LIBRARIES})
endif()

