From 949ef5d1dc751c3bdfad7e83c4d3d8b2bc110347 Mon Sep 17 00:00:00 2001
From: Esteve Fernandez <esteve@apache.org>
Date: Mon, 18 May 2015 12:57:22 -0700
Subject: [PATCH] Added support for lambdas

---
 rclcpp/include/rclcpp/node.hpp | 16 ++++++++++++++--
 1 file changed, 14 insertions(+), 2 deletions(-)

diff --git a/rclcpp/include/rclcpp/node.hpp b/rclcpp/include/rclcpp/node.hpp
index c1a8943..888b962 100644
--- a/rclcpp/include/rclcpp/node.hpp
+++ b/rclcpp/include/rclcpp/node.hpp
@@ -47,9 +47,16 @@ class Executor;
 namespace node
 {
 
-// TODO: add support for functors, std::function, lambdas and object members
 template<typename FunctionT>
-struct function_traits;
+struct function_traits
+{
+  static constexpr std::size_t arity =
+    function_traits<decltype( & FunctionT::operator())>::arity - 1;
+
+  template<std::size_t N>
+  using argument_type =
+      typename function_traits<decltype( & FunctionT::operator())>::template argument_type<N + 1>;
+};
 
 template<typename ReturnTypeT, typename ... Args>
 struct function_traits<ReturnTypeT(Args ...)>
@@ -64,6 +71,11 @@ template<typename ReturnTypeT, typename ... Args>
 struct function_traits<ReturnTypeT (*)(Args ...)>: public function_traits<ReturnTypeT(Args ...)>
 {};
 
+template<typename ClassT, typename ReturnTypeT, typename ... Args>
+struct function_traits<ReturnTypeT (ClassT::*)(Args ...) const>
+  : public function_traits<ReturnTypeT(ClassT &, Args ...)>
+{};
+
 /* ROS Node Interface.
  *
  * This is the single point of entry for creating publishers and subscribers.