mirs_esp
Toggle main menu visibility
読み取り中…
検索中…
一致する文字列を見つけられません
mirs26_esp.ino
[詳解]
1
#include <micro_ros_arduino.h>
2
3
#include <micro_ros_arduino.h>
4
5
#include <micro_ros_arduino.h>
6
#include <stdio.h>
7
#include <rcl/rcl.h>
8
#include <rcl/error_handling.h>
9
#include <rclc/rclc.h>
10
#include <rclc/executor.h>
11
#include <std_msgs/msg/int32_multi_array.h>
12
#include <geometry_msgs/msg/twist.h>
13
#include <mirs_msgs/srv/parameter_update.h>
14
#include <mirs_msgs/srv/simple_command.h>
15
#include <mirs_msgs/msg/basic_param.h>
16
#include <std_msgs/msg/float64_multi_array.h>
17
#include <mirs_msgs/action/trigger.h>
18
#include <pthread.h>
19
#include "
config.h
"
20
21
//topic通信で使用するメッセージ宣言
22
std_msgs__msg__Int32MultiArray
enc_msg
;
//エンコーダー情報
23
std_msgs__msg__Float64MultiArray
vlt_msg
;
//電圧情報
24
std_msgs__msg__Float64MultiArray
curr_vel_msg
;
//速度情報
25
geometry_msgs__msg__Twist
cmd_vel_msg
;
//速度指令値
26
mirs_msgs__msg__BasicParam
param_msg
;
//パラメーターメッセージ
27
28
//service通信で使用するメッセージ宣言
29
mirs_msgs__srv__ParameterUpdate_Response
update_res
;
30
mirs_msgs__srv__ParameterUpdate_Request
update_req
;
31
mirs_msgs__srv__SimpleCommand_Response
reset_res
;
32
mirs_msgs__srv__SimpleCommand_Request
reset_req
;
33
34
//publisher,subscriber,serviceの宣言
35
rcl_publisher_t
enc_pub
;
36
rcl_publisher_t
vlt_pub
;
37
rcl_publisher_t
curr_vel_pub
;
38
rcl_subscription_t
cmd_vel_sub
;
39
rcl_subscription_t
param_sub
;
40
rcl_service_t
update_srv
;
41
rcl_service_t
reset_srv
;
42
43
//ノードに関わる宣言
44
rclc_executor_t
executor
;
45
rclc_support_t
support
;
46
rcl_allocator_t
allocator
;
47
rcl_node_t
node
;
48
rcl_timer_t
timer
;
49
50
/* 処理で使用するグローバル変数 */
51
52
//エンコーダーカウント
53
int32_t
count_l
= 0;
54
int32_t
count_r
= 0;
55
56
int32_t
prev_count_l
= 0;
57
int32_t
prev_count_r
= 0;
58
59
//速度制御用の変数
60
double
r_vel_cmd
;
61
double
l_vel_cmd
;
62
double
r_vel
;
63
double
l_vel
;
64
65
float
linear_x
;
// 直進速度
66
float
angular_z
;
// 回転速度
67
68
float
r_err_sum
= 0;
69
float
l_err_sum
= 0;
70
71
float
prev_r_err
= 0;
72
float
prev_l_err
= 0;
73
74
//電圧
75
double
vlt_1
= 0;
76
double
vlt_2
= 0;
77
78
//WatchDog用
79
uint32_t
lastCalledAt
;
80
81
void
setup
() {
82
ros_setup
();
83
84
encoder_open
();
85
vel_ctrl_set
();
86
vlt_setup
();
87
88
delay(500);
89
}
90
91
void
loop
() {
92
delay(10);
93
rclc_executor_spin_some(&
executor
, RCL_MS_TO_NS(100));
94
}
config.h
機体のピン、通信、制御に使う定数を定義する。
encoder_open
void encoder_open()
定義
encoder.ino:29
prev_r_err
float prev_r_err
定義
mirs26_esp.ino:71
reset_srv
rcl_service_t reset_srv
定義
mirs26_esp.ino:41
reset_res
mirs_msgs__srv__SimpleCommand_Response reset_res
定義
mirs26_esp.ino:31
lastCalledAt
uint32_t lastCalledAt
定義
mirs26_esp.ino:79
vlt_pub
rcl_publisher_t vlt_pub
定義
mirs26_esp.ino:36
enc_pub
rcl_publisher_t enc_pub
定義
mirs26_esp.ino:35
l_vel
double l_vel
定義
mirs26_esp.ino:63
vlt_2
double vlt_2
定義
mirs26_esp.ino:76
curr_vel_msg
std_msgs__msg__Float64MultiArray curr_vel_msg
定義
mirs26_esp.ino:24
setup
void setup()
定義
mirs26_esp.ino:81
param_sub
rcl_subscription_t param_sub
定義
mirs26_esp.ino:39
prev_count_r
int32_t prev_count_r
定義
mirs26_esp.ino:57
l_err_sum
float l_err_sum
定義
mirs26_esp.ino:69
reset_req
mirs_msgs__srv__SimpleCommand_Request reset_req
定義
mirs26_esp.ino:32
linear_x
float linear_x
定義
mirs26_esp.ino:65
update_res
mirs_msgs__srv__ParameterUpdate_Response update_res
定義
mirs26_esp.ino:29
update_srv
rcl_service_t update_srv
定義
mirs26_esp.ino:40
executor
rclc_executor_t executor
定義
mirs26_esp.ino:44
r_err_sum
float r_err_sum
定義
mirs26_esp.ino:68
param_msg
mirs_msgs__msg__BasicParam param_msg
定義
mirs26_esp.ino:26
r_vel
double r_vel
定義
mirs26_esp.ino:62
cmd_vel_msg
geometry_msgs__msg__Twist cmd_vel_msg
定義
mirs26_esp.ino:25
cmd_vel_sub
rcl_subscription_t cmd_vel_sub
定義
mirs26_esp.ino:38
l_vel_cmd
double l_vel_cmd
定義
mirs26_esp.ino:61
r_vel_cmd
double r_vel_cmd
定義
mirs26_esp.ino:60
update_req
mirs_msgs__srv__ParameterUpdate_Request update_req
定義
mirs26_esp.ino:30
node
rcl_node_t node
定義
mirs26_esp.ino:47
prev_l_err
float prev_l_err
定義
mirs26_esp.ino:72
vlt_msg
std_msgs__msg__Float64MultiArray vlt_msg
定義
mirs26_esp.ino:23
enc_msg
std_msgs__msg__Int32MultiArray enc_msg
定義
mirs26_esp.ino:22
allocator
rcl_allocator_t allocator
定義
mirs26_esp.ino:46
count_r
int32_t count_r
定義
mirs26_esp.ino:54
vlt_1
double vlt_1
定義
mirs26_esp.ino:75
prev_count_l
int32_t prev_count_l
定義
mirs26_esp.ino:56
support
rclc_support_t support
定義
mirs26_esp.ino:45
count_l
int32_t count_l
定義
mirs26_esp.ino:53
timer
rcl_timer_t timer
定義
mirs26_esp.ino:48
angular_z
float angular_z
定義
mirs26_esp.ino:66
loop
void loop()
定義
mirs26_esp.ino:91
curr_vel_pub
rcl_publisher_t curr_vel_pub
定義
mirs26_esp.ino:37
ros_setup
void ros_setup()
定義
ros_setup.ino:1
vel_ctrl_set
void vel_ctrl_set()
定義
vel_ctrl.ino:76
vlt_setup
void vlt_setup()
定義
vlt_obserber.ino:6
mirs26_esp
mirs26_esp.ino
構築:
1.18.0