# Locate the g2o libraries
# A general framework for graph optimization.
#
# This module defines
# G2O_FOUND, if false, do not try to link against g2o
# G2O_LIBRARIES, path to the libg2o
# G2O_INCLUDE_DIR, where to find the g2o header files
#
# Niko Suenderhauf <niko@etit.tu-chemnitz.de>
# Adapted by Felix Endres <endres@informatik.uni-freiburg.de>

IF(UNIX)

  IF(G2O_INCLUDE_DIR AND G2O_LIBRARIES)
    # in cache already
    SET(G2O_FIND_QUIETLY TRUE)
  ENDIF(G2O_INCLUDE_DIR AND G2O_LIBRARIES)

  MESSAGE(STATUS "Searching for g2o ...")
  IF(NOT "$ENV{G2O_DIR}" STREQUAL "")
    MESSAGE(STATUS "Searching for g2o in $ENV{G2O_DIR}")
  ENDIF()
  FIND_PATH(G2O_INCLUDE_DIR
    NAMES g2o/core/sparse_optimizer.h
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES include/g2o include)

  IF (G2O_INCLUDE_DIR)
    MESSAGE(STATUS "Found g2o headers in: ${G2O_INCLUDE_DIR}")
  ENDIF (G2O_INCLUDE_DIR)

  FIND_LIBRARY(G2O_CORE_LIB
    NAMES g2o_core
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES lib)
  FIND_LIBRARY(G2O_STUFF_LIB
    NAMES g2o_stuff
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES lib)
  FIND_LIBRARY(G2O_TYPES_SLAM3D_LIB
    NAMES g2o_types_slam3d
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES lib)
  FIND_LIBRARY(G2O_SOLVER_CHOLMOD_LIB
    NAMES g2o_solver_cholmod
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES lib)
  FIND_LIBRARY(G2O_SOLVER_PCG_LIB
    NAMES g2o_solver_pcg
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES lib)
  FIND_LIBRARY(G2O_SOLVER_CSPARSE_LIB
    NAMES g2o_solver_csparse
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES lib)
  FIND_LIBRARY(G2O_CSPARSE_EXTENSION_LIB
    NAMES g2o_csparse_extension
    PATHS $ENV{G2O_DIR} /usr/local /usr
    PATH_SUFFIXES lib)

  SET(G2O_LIBRARIES ${G2O_CSPARSE_EXTENSION_LIB}
                    ${G2O_CORE_LIB}
                    ${G2O_STUFF_LIB}
                    ${G2O_TYPES_SLAM3D_LIB}
                    ${G2O_SOLVER_CHOLMOD_LIB}
                    ${G2O_SOLVER_PCG_LIB}
                    ${G2O_SOLVER_CSPARSE_LIB}
                    )

  IF(G2O_LIBRARIES AND G2O_INCLUDE_DIR)
    SET(G2O_FOUND "YES")
    IF(NOT G2O_FIND_QUIETLY)
      MESSAGE(STATUS "Found libg2o: ${G2O_LIBRARIES}")
    ENDIF(NOT G2O_FIND_QUIETLY)
  ELSE(G2O_LIBRARIES AND G2O_INCLUDE_DIR)
    IF(NOT G2O_LIBRARIES)
      IF(G2O_FIND_REQUIRED)
        message(FATAL_ERROR "Could not find libg2o!")
      ENDIF(G2O_FIND_REQUIRED)
    ENDIF(NOT G2O_LIBRARIES)

    IF(NOT G2O_INCLUDE_DIR)
      IF(G2O_FIND_REQUIRED)
        message(FATAL_ERROR "Could not find g2o include directory!")
      ENDIF(G2O_FIND_REQUIRED)
    ENDIF(NOT G2O_INCLUDE_DIR)
  ENDIF(G2O_LIBRARIES AND G2O_INCLUDE_DIR)

ENDIF(UNIX)