# Copyright (c) 2017, United States Government, as represented by the
# Administrator of the National Aeronautics and Space Administration.
# 
# All rights reserved.
# 
# The Astrobee platform is licensed under the Apache License, Version 2.0
# (the "License"); you may not use this file except in compliance with the
# License. You may obtain a copy of the License at
# 
#     http://www.apache.org/licenses/LICENSE-2.0
# 
# Unless required by applicable law or agreed to in writing, software
# distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
# WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
# License for the specific language governing permissions and limitations
# under the License.

# - Try to find OCTOMAP
# Will define
# OCTOMAP_FOUND - If Succeful
# OCTOMAP_INCLUDE_DIRS - The OCTOMAP include directories
# OCTOMAP_LIBRARIES - The OCTOMAP library

find_path(OCTOMAP_INCLUDE_DIR
  NAMES "octomap/octomap.h"
  PATHS /opt/ros/kinetic/include
  )

find_library(OCTOMAP_LIBRARY
  NAMES octomap
  PATHS /opt/ros/kinetic/lib
  )

find_library(OCTOMATH_LIBRARY
  NAMES octomath
  PATHS /opt/ros/kinetic/lib
  )

set(OCTOMAP_INCLUDE_DIRS "${OCTOMAP_INCLUDE_DIR}")
set(OCTOMAP_LIBRARIES "${OCTOMAP_LIBRARY};${OCTOMATH_LIBRARY}" )

include(FindPackageHandleStandardArgs)
find_package_handle_standard_args(OCTOMAP DEFAULT_MSG OCTOMAP_LIBRARIES OCTOMAP_INCLUDE_DIR)
mark_as_advanced(OCTOMAP_LIBRARIES OCTOMAP_INCLUDE_DIR)
