mirs_esp
読み取り中…
検索中…
一致する文字列を見つけられません
encoder.ino
[詳解]
1
3 count_l = 0;
4 count_r = 0;
5}
6
7static void enc_change_l() {
8 int32_t a_curr = digitalRead(PIN_ENC_A_L);
9 int32_t b_curr = digitalRead(PIN_ENC_B_L);
10
11 if(a_curr == b_curr){
12 count_l--;
13 }else{
14 count_l++;
15 }
16}
17
18static void enc_change_r() {
19 int32_t a_curr = digitalRead(PIN_ENC_A_R);
20 int32_t b_curr = digitalRead(PIN_ENC_B_R);
21
22 if(a_curr == b_curr){
23 count_r++;
24 }else{
25 count_r--;
26 }
27}
28
30 pinMode(PIN_ENC_A_L, INPUT);
31 pinMode(PIN_ENC_B_L, INPUT);
32 pinMode(PIN_ENC_A_R, INPUT);
33 pinMode(PIN_ENC_B_R, INPUT);
34 digitalWrite(PIN_ENC_A_L, HIGH);
35 digitalWrite(PIN_ENC_B_L, HIGH);
36 digitalWrite(PIN_ENC_A_R, HIGH);
37 digitalWrite(PIN_ENC_B_R, HIGH);
38 attachInterrupt(PIN_ENC_A_L, enc_change_l, CHANGE);
39 attachInterrupt(PIN_ENC_A_R, enc_change_r, CHANGE);
40
41 enc_msg.data.size = 2; // メッセージ配列のサイズを3に設定
42 enc_msg.data.data = (int32_t *)malloc(enc_msg.data.size * sizeof(int32_t)); // 配列のメモリを確保
43 enc_msg.data.data[0] = 0;
44 enc_msg.data.data[1] = 0;
45}
#define PIN_ENC_B_R
定義 config.h:5
#define PIN_ENC_A_L
定義 config.h:2
#define PIN_ENC_B_L
定義 config.h:3
#define PIN_ENC_A_R
定義 config.h:4
void encoder_reset()
void encoder_open()
static void enc_change_r()
static void enc_change_l()
std_msgs__msg__Int32MultiArray enc_msg
int32_t count_r
int32_t count_l