mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
ros_task.cpp ファイル

micro-ROSの接続と再接続、指令の受信、計測値の配信を処理する。 [詳解]

#include "ros_task.hpp"
#include <micro_ros_platformio.h>
#include <Arduino.h>
#include <freertos/FreeRTOS.h>
#include <freertos/task.h>
#include <rcl/rcl.h>
#include <rclc/rclc.h>
#include <rclc/executor.h>
#include <rmw_microros/rmw_microros.h>
#include <geometry_msgs/msg/twist.h>
#include <std_msgs/msg/empty.h>
#include <mirs_msgs/msg/basic_param.h>
#include <cmath>
#include "../publishers/imu_publisher.hpp"
#include "../publishers/odom_publisher.hpp"
#include "../publishers/publisher_plugin.hpp"
#include "../publishers/telemetry_publisher.hpp"
#include "hardware_config.hpp"
#include "SystemContext.hpp"
#include "control_task.hpp"

[ソースコード]

マクロ定義

#define ROS_DOMAIN_ID   90
#define PARAM_RADIUS_MAX   0.5
#define PARAM_BASE_MAX   2.0
#define PARAM_GAIN_ABS_MAX   1000.0
#define ROS_CHECK(fn)

関数

static void cmd_vel_callback (const void *msgin)
static bool paramsInRange (const mirs_msgs__msg__BasicParam *p)
static void param_callback (const void *msgin)
static void reset_odom_callback (const void *)
static void timer_callback (rcl_timer_t *, int64_t)
static bool ros_setup ()
static void ros_teardown ()
void rosTask (void *arg)

変数

static rcl_allocator_t allocator
static rclc_support_t support
static rcl_node_t node
static rclc_executor_t executor
static rcl_timer_t timer
static rcl_subscription_t cmd_vel_sub
static rcl_subscription_t param_sub
static rcl_subscription_t reset_odom_sub
static geometry_msgs__msg__Twist cmd_vel_msg
static mirs_msgs__msg__BasicParam param_msg
static std_msgs__msg__Empty reset_odom_msg
static ImuPublisher imu_pub_plugin
static OdomPublisher odom_pub_plugin
static TelemetryPublisher telemetry_pub_plugin
static IPublisherPlugin * publishers []
static uint32_t last_param_ms = 0
static bool params_seen = false

詳解

micro-ROSの接続と再接続、指令の受信、計測値の配信を処理する。

ros_task.cpp に定義があります。

マクロ定義詳解

◆ PARAM_BASE_MAX

#define PARAM_BASE_MAX   2.0

ros_task.cpp の 30 行目に定義があります。

◆ PARAM_GAIN_ABS_MAX

#define PARAM_GAIN_ABS_MAX   1000.0

ros_task.cpp の 31 行目に定義があります。

◆ PARAM_RADIUS_MAX

#define PARAM_RADIUS_MAX   0.5

ros_task.cpp の 29 行目に定義があります。

◆ ROS_CHECK

#define ROS_CHECK ( fn)
値:
do { \
rcl_ret_t _rc = (fn); \
if (_rc != RCL_RET_OK) { \
Serial.printf("[ros] setup failed: %s:%d rc=%d\n", __func__, __LINE__, (int)_rc); \
return false; \
} \
} while (0)

ros_task.cpp の 151 行目に定義があります。

◆ ROS_DOMAIN_ID

#define ROS_DOMAIN_ID   90

ros_task.cpp の 26 行目に定義があります。

関数詳解

◆ cmd_vel_callback()

void cmd_vel_callback ( const void * msgin)
static

ros_task.cpp の 65 行目に定義があります。

◆ param_callback()

void param_callback ( const void * msgin)
static

ros_task.cpp の 111 行目に定義があります。

◆ paramsInRange()

bool paramsInRange ( const mirs_msgs__msg__BasicParam * p)
static

ros_task.cpp の 93 行目に定義があります。

◆ reset_odom_callback()

void reset_odom_callback ( const void * )
static

ros_task.cpp の 133 行目に定義があります。

◆ ros_setup()

bool ros_setup ( )
static

ros_task.cpp の 160 行目に定義があります。

◆ ros_teardown()

void ros_teardown ( )
static

ros_task.cpp の 212 行目に定義があります。

◆ rosTask()

void rosTask ( void * arg)

ros_task.cpp の 225 行目に定義があります。

◆ timer_callback()

void timer_callback ( rcl_timer_t * ,
int64_t  )
static

ros_task.cpp の 137 行目に定義があります。

変数詳解

◆ allocator

rcl_allocator_t allocator
static

ros_task.cpp の 36 行目に定義があります。

◆ cmd_vel_msg

geometry_msgs__msg__Twist cmd_vel_msg
static

ros_task.cpp の 44 行目に定義があります。

◆ cmd_vel_sub

rcl_subscription_t cmd_vel_sub
static

ros_task.cpp の 42 行目に定義があります。

◆ executor

rclc_executor_t executor
static

ros_task.cpp の 39 行目に定義があります。

◆ imu_pub_plugin

ImuPublisher imu_pub_plugin
static

ros_task.cpp の 50 行目に定義があります。

◆ last_param_ms

uint32_t last_param_ms = 0
static

ros_task.cpp の 61 行目に定義があります。

◆ node

rcl_node_t node
static

ros_task.cpp の 38 行目に定義があります。

◆ odom_pub_plugin

OdomPublisher odom_pub_plugin
static

ros_task.cpp の 51 行目に定義があります。

◆ param_msg

mirs_msgs__msg__BasicParam param_msg
static

ros_task.cpp の 45 行目に定義があります。

◆ param_sub

rcl_subscription_t param_sub
static

ros_task.cpp の 42 行目に定義があります。

◆ params_seen

bool params_seen = false
static

ros_task.cpp の 62 行目に定義があります。

◆ publishers

IPublisherPlugin* publishers[]
static
初期値:
= {
}
static OdomPublisher odom_pub_plugin
static ImuPublisher imu_pub_plugin
static TelemetryPublisher telemetry_pub_plugin

ros_task.cpp の 53 行目に定義があります。

◆ reset_odom_msg

std_msgs__msg__Empty reset_odom_msg
static

ros_task.cpp の 46 行目に定義があります。

◆ reset_odom_sub

rcl_subscription_t reset_odom_sub
static

ros_task.cpp の 42 行目に定義があります。

◆ support

rclc_support_t support
static

ros_task.cpp の 37 行目に定義があります。

◆ telemetry_pub_plugin

TelemetryPublisher telemetry_pub_plugin
static

ros_task.cpp の 52 行目に定義があります。

◆ timer

rcl_timer_t timer
static

ros_task.cpp の 40 行目に定義があります。