mirs_esp
Toggle main menu visibility
読み取り中…
検索中…
一致する文字列を見つけられません
topic_callback.ino
[詳解]
1
//ノードのタイマーコールバック関数
2
void
timer_callback
(rcl_timer_t *
timer
, int64_t last_call_time)
3
{
4
RCLC_UNUSED(last_call_time);
5
if
(
timer
!= NULL) {
6
//PID計算
7
PID_control
();
8
//エンコーダーデータを格納
9
enc_msg
.data.data[0] =
count_l
;
10
enc_msg
.data.data[1] =
count_r
;
11
//電圧観測
12
vlt_watch
();
13
// watchdog
14
if
( (millis() -
lastCalledAt
) >
WATCHDOG_TIMEOUT
){
15
r_vel_cmd
= 0;
16
l_vel_cmd
= 0;
17
}
18
19
curr_vel_msg
.data.data[0] =
l_vel
;
20
curr_vel_msg
.data.data[1] =
r_vel
;
21
vlt_msg
.data.data[0] =
vlt_1
;
22
vlt_msg
.data.data[1] =
vlt_2
;
23
rcl_publish(&
enc_pub
, &
enc_msg
, NULL);
24
rcl_publish(&
vlt_pub
, &
vlt_msg
, NULL);
25
rcl_publish(&
curr_vel_pub
, &
curr_vel_msg
, NULL);
26
}
27
}
28
29
// cmd_velメッセージのコールバック関数
30
void
cmd_vel_Callback
(
const
void
* msgin) {
31
const
geometry_msgs__msg__Twist * vel_msg = (
const
geometry_msgs__msg__Twist *)msgin;
32
33
// linear.x と angular.z のデータを取得
34
linear_x
= vel_msg->linear.x;
35
angular_z
= vel_msg->angular.z;
36
37
// 目標速度計算
38
r_vel_cmd
=
linear_x
+
WHEEL_BASE
/ 2 *
angular_z
;
39
l_vel_cmd
=
linear_x
-
WHEEL_BASE
/ 2 *
angular_z
;
40
41
// WatchDog用 最後に呼び出された時間を格納
42
lastCalledAt
= millis();
43
}
44
45
//TODO: 消してサービスに移行
46
//パラメーター更新のコールバック関数
47
void
param_Callback
(
const
void
* msgin){
48
const
mirs_msgs__msg__BasicParam *
param_msg
= (
const
mirs_msgs__msg__BasicParam *)msgin;
49
50
// linear.x と angular.z のデータを取得
51
WHEEL_RADIUS
=
param_msg
->wheel_radius;
52
WHEEL_BASE
=
param_msg
->wheel_base;
53
RKP
=
param_msg
->rkp;
54
RKI
=
param_msg
->rki;
55
RKD
=
param_msg
->rkd;
56
LKP
=
param_msg
->lkp;
57
LKI
=
param_msg
->lki;
58
LKD
=
param_msg
->lkd;
59
}
RKP
double RKP
定義
config.h:22
LKI
double LKI
定義
config.h:26
RKI
double RKI
定義
config.h:23
LKP
double LKP
定義
config.h:25
RKD
double RKD
定義
config.h:24
LKD
double LKD
定義
config.h:27
WHEEL_RADIUS
double WHEEL_RADIUS
定義
config.h:31
WHEEL_BASE
double WHEEL_BASE
定義
config.h:32
WATCHDOG_TIMEOUT
#define WATCHDOG_TIMEOUT
定義
config.h:15
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
linear_x
float linear_x
定義
mirs26_esp.ino:65
param_msg
mirs_msgs__msg__BasicParam param_msg
定義
mirs26_esp.ino:26
r_vel
double r_vel
定義
mirs26_esp.ino:62
l_vel_cmd
double l_vel_cmd
定義
mirs26_esp.ino:61
r_vel_cmd
double r_vel_cmd
定義
mirs26_esp.ino:60
vlt_msg
std_msgs__msg__Float64MultiArray vlt_msg
定義
mirs26_esp.ino:23
enc_msg
std_msgs__msg__Int32MultiArray enc_msg
定義
mirs26_esp.ino:22
count_r
int32_t count_r
定義
mirs26_esp.ino:54
vlt_1
double vlt_1
定義
mirs26_esp.ino:75
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
curr_vel_pub
rcl_publisher_t curr_vel_pub
定義
mirs26_esp.ino:37
param_Callback
void param_Callback(const void *msgin)
定義
topic_callback.ino:47
timer_callback
void timer_callback(rcl_timer_t *timer, int64_t last_call_time)
定義
topic_callback.ino:2
cmd_vel_Callback
void cmd_vel_Callback(const void *msgin)
定義
topic_callback.ino:30
PID_control
void PID_control()
定義
vel_ctrl.ino:22
vlt_watch
void vlt_watch()
定義
vlt_obserber.ino:1
mirs26_esp
topic_callback.ino
構築:
1.18.0