Paradiseの何でも工作室

Raspberry pi PicoをArduino IDEを使ってプログラミング
マイコンにRaspberry pi PicoとArduino Pro Microを使った2車体を作りましたが、どちらもArduino IDEを使って
プログラミングしました。何れの車体にも赤外線距離センサーを付けましたが、通常ライントレースカーは
2台同時に走らせることが無いのでその部分は省略しています。　前回までの製作編と併せてご覧下さい。


Raspberry pi Picoのプログラミング例
Raspberry pi PicoをArduino IDEで使うには、ボードマネージャにRaspberry pi　RP2040 Boards又は
Arduino Mbed OS RP2040 Boardsが、インストールされている必要があります。
Arduino Pro Microを使う場合はIOピン番号と名称が変わるだけで基本は同じです。

注意点
①21行目からのPWM信号は0～255の数値を入力しますが、大き過ぎるとスピードが出過ぎてカーブを
曲がり切れません。使用するギアモーターに合わせてカットアンドトライで決めます。
②54行目からはラインセンサーの読み取り値からコースの下地の白色とラインの黒色を識別する部分です。
しきい値は、使用するセンサーの種類、回路定数、取り付け方法、対物距離などによって出力値が変わるので
カットアンドトライで決めます。

---

1. #define IN1 6 // GPIO 6
2. #define IN2 7 // GPI0 7
3. #define IN3 8 // GPIO 8
4. #define IN4 9 // GPIO 9
6. int Left_val;
7. int Center_val;
8. int Right_val;
9. int L_SENS;
10. int C_SENS;
11. int R_SENS;
13. void setup() {
14.   Serial.begin(115200);
15.   pinMode(IN1, OUTPUT); analogWrite(IN1 , 0);
16.   pinMode(IN2, OUTPUT); analogWrite(IN2 , 0);
17.   pinMode(IN3, OUTPUT); analogWrite(IN3 , 0);
18.   pinMode(IN4, OUTPUT); analogWrite(IN4 , 0);
19. }
21. void Forward() { //前進
22.   analogWrite(IN1, 75); // PWM 0〜255
23.   analogWrite(IN2, 0); // PWM 0
24.   analogWrite(IN3, 0); // PWM 0
25.   analogWrite(IN4, 75); // PWM 0〜255
26. }
28. void Turnleft() { //左旋回
29.   analogWrite(IN1, 0); // PWM 0
30.   analogWrite(IN2, 60); // PWM 0〜255
31.   analogWrite(IN3, 0); // PWM 0
32.   analogWrite(IN4, 110); // PWM 0〜255
33. }
35. void Turnright() { //右旋回
36.   analogWrite(IN1, 110); // PWM 0〜255
37.   analogWrite(IN2, 0); // PWM 0
38.   analogWrite(IN3, 60); // PWM 0〜255
39.   analogWrite(IN4, 0); // PWM 0
40. }
42. void Stop() { //停止
43.   analogWrite(IN1, 0); // PWM 0
44.   analogWrite(IN2, 0); // PWM 0
45.   analogWrite(IN3, 0); // PWM 0
46.   analogWrite(IN4, 0); // PWM 0
47. }
49. void loop() {
50.   Left_val = analogRead(26); // 左センサーの出力値 0〜255
51.   Center_val = analogRead(27); // 中央センサーの出力値 0〜255
52.   Right_val = analogRead(28); // 右センサーの出力値 0〜255
54.   if (Left_val <= 100) { //　しきい値 100以下は白
55.     L_SENS = 0; // 白色
56.   }
57.   else {
58.     L_SENS = 1; // 黒色
59.   }
61.   if (Center_val <= 100) { //　しきい値 100以下は白
62.     C_SENS = 0; // 白色
63.   }
64.   else {
65.     C_SENS = 1; // 黒色
66.   }
68.   if (Right_val <= 100) { //　しきい値 100以下は白
69.     R_SENS = 0; // 白色
70.   }
71.   else {
72.     R_SENS = 1; // 黒色
73.   }
74.   if (L_SENS == 0 && C_SENS == 1 && R_SENS == 0) { // Forwar　前進
75.     Forward();
76.   }
78.   else if (L_SENS == 1 && C_SENS == 1 && R_SENS == 1) { // Forward　前進
79.     Forward();
80.   }
82.   else if (L_SENS == 1 && C_SENS == 1 && R_SENS == 0) { // Turnleft　左旋回
83.     Turnleft();
84.   }
86.   else if (L_SENS == 0 && C_SENS == 1 && R_SENS == 1) { // Turnright　右旋回
87.     Turnright();
88.   }
90.   else if (L_SENS == 0 && C_SENS == 0 && R_SENS == 0) { // Stop　停止
91.     Stop();
92.   }
93.   /*Serial.print(" L = ");
94.     Serial.print(L_SENS);
95.     Serial.print(" C = ");
96.     Serial.print(C_SENS);
97.     Serial.print(" R = ");
98.     Serial.println(R_SENS);*/
99. }

---

次回はMicro Pythonを使ったプログラミング例を紹介します。

---

皆様の参考になれば幸いです。
by Paradise

テーマ : 電子工作
ジャンル : 趣味・実用