2019-05-16 12:54:01 +02:00
|
|
|
#include "tracetools/tracetools.h"
|
|
|
|
|
2019-05-27 11:47:50 +02:00
|
|
|
#if defined(WITH_LTTNG) && !defined(_WIN32)
|
2019-05-20 15:17:00 +02:00
|
|
|
# include "tp_call.h"
|
|
|
|
# define CONDITIONAL_TP(...) \
|
2019-06-05 15:35:46 +02:00
|
|
|
tracepoint(__VA_ARGS__)
|
2019-05-17 14:57:36 +02:00
|
|
|
#else
|
2019-05-20 15:17:00 +02:00
|
|
|
# define CONDITIONAL_TP(...)
|
2019-05-16 12:54:01 +02:00
|
|
|
#endif
|
|
|
|
|
2019-05-16 14:16:40 +02:00
|
|
|
bool ros_trace_compile_status()
|
|
|
|
{
|
2019-05-27 11:47:50 +02:00
|
|
|
#if defined(WITH_LTTNG) && !defined(_WIN32)
|
2019-05-16 14:16:40 +02:00
|
|
|
return true;
|
2019-05-16 12:54:01 +02:00
|
|
|
#else
|
2019-05-16 14:16:40 +02:00
|
|
|
return false;
|
2019-05-16 12:54:01 +02:00
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2019-05-17 15:42:30 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
rcl_init,
|
2019-06-07 13:25:16 +02:00
|
|
|
const void * context_handle)
|
2019-05-16 14:16:40 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rcl_init,
|
2019-06-17 10:25:25 +02:00
|
|
|
context_handle,
|
2019-06-17 11:15:57 +02:00
|
|
|
tracetools_VERSION);
|
2019-05-16 12:54:01 +02:00
|
|
|
}
|
2019-05-16 13:36:59 +02:00
|
|
|
|
2019-05-17 14:57:36 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
rcl_node_init,
|
2019-05-20 13:58:06 +02:00
|
|
|
const void * node_handle,
|
|
|
|
const void * rmw_handle,
|
2019-05-17 14:57:36 +02:00
|
|
|
const char * node_name,
|
2019-05-20 13:58:06 +02:00
|
|
|
const char * node_namespace)
|
2019-05-16 14:16:40 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rcl_node_init,
|
|
|
|
node_handle,
|
|
|
|
rmw_handle,
|
|
|
|
node_name,
|
|
|
|
node_namespace);
|
2019-05-16 13:36:59 +02:00
|
|
|
}
|
|
|
|
|
2019-05-17 14:57:36 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
rcl_publisher_init,
|
2019-05-20 13:58:06 +02:00
|
|
|
const void * publisher_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
const void * node_handle,
|
2019-05-28 14:57:15 +02:00
|
|
|
const void * rmw_publisher_handle,
|
2019-05-27 15:19:11 +02:00
|
|
|
const char * topic_name,
|
2019-06-17 10:13:55 +02:00
|
|
|
const size_t queue_depth)
|
2019-05-16 14:16:40 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rcl_publisher_init,
|
|
|
|
publisher_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
node_handle,
|
2019-06-05 15:35:46 +02:00
|
|
|
rmw_publisher_handle,
|
|
|
|
topic_name,
|
2019-06-17 10:13:55 +02:00
|
|
|
queue_depth);
|
2019-05-16 13:36:59 +02:00
|
|
|
}
|
|
|
|
|
2019-05-17 14:57:36 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
rcl_subscription_init,
|
2019-05-17 14:59:31 +02:00
|
|
|
const void * subscription_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
const void * node_handle,
|
2019-05-28 14:57:15 +02:00
|
|
|
const void * rmw_subscription_handle,
|
2019-05-27 16:48:45 +02:00
|
|
|
const char * topic_name,
|
2019-06-17 10:13:55 +02:00
|
|
|
const size_t queue_depth)
|
2019-05-16 14:16:40 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rcl_subscription_init,
|
|
|
|
subscription_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
node_handle,
|
2019-06-05 15:35:46 +02:00
|
|
|
rmw_subscription_handle,
|
|
|
|
topic_name,
|
2019-06-17 10:13:55 +02:00
|
|
|
queue_depth);
|
2019-05-17 14:59:31 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void TRACEPOINT(
|
2019-06-05 15:35:46 +02:00
|
|
|
rclcpp_subscription_callback_added,
|
|
|
|
const void * subscription_handle,
|
|
|
|
const void * callback)
|
2019-05-17 14:59:31 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rclcpp_subscription_callback_added,
|
|
|
|
subscription_handle,
|
|
|
|
callback);
|
2019-05-16 13:36:59 +02:00
|
|
|
}
|
2019-05-17 09:05:34 +02:00
|
|
|
|
2019-05-20 11:45:19 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
rcl_service_init,
|
2019-05-20 13:58:06 +02:00
|
|
|
const void * service_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
const void * node_handle,
|
2019-05-28 14:57:15 +02:00
|
|
|
const void * rmw_service_handle,
|
2019-05-20 11:45:19 +02:00
|
|
|
const char * service_name)
|
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rcl_service_init,
|
|
|
|
service_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
node_handle,
|
2019-06-05 15:35:46 +02:00
|
|
|
rmw_service_handle,
|
|
|
|
service_name);
|
2019-05-20 11:45:19 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void TRACEPOINT(
|
|
|
|
rclcpp_service_callback_added,
|
2019-05-20 13:58:06 +02:00
|
|
|
const void * service_handle,
|
2019-05-20 11:45:19 +02:00
|
|
|
const void * callback)
|
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rclcpp_service_callback_added,
|
|
|
|
service_handle,
|
|
|
|
callback);
|
2019-05-20 11:45:19 +02:00
|
|
|
}
|
|
|
|
|
2019-05-28 14:15:46 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
rcl_client_init,
|
|
|
|
const void * client_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
const void * node_handle,
|
2019-05-28 14:15:46 +02:00
|
|
|
const void * rmw_client_handle,
|
|
|
|
const char * service_name)
|
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rcl_client_init,
|
|
|
|
client_handle,
|
2019-06-07 14:35:29 +02:00
|
|
|
node_handle,
|
2019-06-05 15:35:46 +02:00
|
|
|
rmw_client_handle,
|
|
|
|
service_name);
|
2019-05-28 14:15:46 +02:00
|
|
|
}
|
|
|
|
|
2019-05-28 13:13:53 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
rcl_timer_init,
|
|
|
|
const void * timer_handle,
|
2019-06-05 15:35:46 +02:00
|
|
|
int64_t period)
|
2019-05-28 13:13:53 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rcl_timer_init,
|
|
|
|
timer_handle,
|
|
|
|
period);
|
2019-05-28 13:13:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void TRACEPOINT(
|
|
|
|
rclcpp_timer_callback_added,
|
|
|
|
const void * timer_handle,
|
|
|
|
const void * callback)
|
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
rclcpp_timer_callback_added,
|
|
|
|
timer_handle,
|
|
|
|
callback);
|
2019-05-28 13:13:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void TRACEPOINT(
|
2019-06-14 10:08:24 +02:00
|
|
|
rclcpp_callback_register,
|
|
|
|
const void * callback,
|
|
|
|
const char * function_symbol)
|
2019-05-28 13:13:53 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
2019-06-14 10:08:24 +02:00
|
|
|
rclcpp_callback_register,
|
|
|
|
callback,
|
|
|
|
function_symbol);
|
2019-05-28 13:13:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void TRACEPOINT(
|
2019-06-14 10:08:24 +02:00
|
|
|
callback_start,
|
|
|
|
const void * callback,
|
|
|
|
const bool is_intra_process)
|
2019-05-28 13:13:53 +02:00
|
|
|
{
|
2019-06-05 15:35:46 +02:00
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
2019-06-14 10:08:24 +02:00
|
|
|
callback_start,
|
|
|
|
callback,
|
|
|
|
(is_intra_process ? 1 : 0));
|
2019-05-28 13:13:53 +02:00
|
|
|
}
|
2019-05-28 14:16:38 +02:00
|
|
|
|
2019-06-14 10:08:24 +02:00
|
|
|
void TRACEPOINT(
|
|
|
|
callback_end,
|
|
|
|
const void * callback)
|
|
|
|
{
|
|
|
|
CONDITIONAL_TP(
|
|
|
|
ros2,
|
|
|
|
callback_end,
|
|
|
|
callback);
|
2019-05-28 14:16:38 +02:00
|
|
|
}
|