11. 速度のキャリブレーション¶

車を前進させる際、車がまっすぐ進まないことがあります。これは、工場出荷時に2つのモーターの速度が同じでない可能性があるためです。しかし、2つのモーターにオフセットを書き込むことで、それらの回転速度を収束させることができます。

このプロジェクトでは、 EEPROM にオフセットを保存する方法を学びます。この目的は、各キャリブレーション後、すべてのプロジェクトがEEPROMから直接オフセット値を取得できるようにするため、車がスムーズにまっすぐ進むことができます。

配線

このプロジェクトの配線は 2. コードによる移動と同じです。

遊び方は？

3in1-kit\car_project\11.speed_calibration のパスの下にある 11.speed_calibration.ino ファイルを開きます。または、このコードを Arduino IDE にコピーします。

コードが正常にアップロードされた後、車を9Vのバッテリーに接続し、地面に置いて前進させ、どちら側にオフセットされているかを確認します。

車が左前方に進む場合、右モーターの速度が速すぎることを意味し、速度を減少させる必要があります。
EEPROM.write(1, 100) // 1 means the right motor, 100 means 100% speed, can be set to 90, 95, etc., depending on the actual situation.

車が右側に移動する場合、左モーターの速度が速すぎることを意味し、速度を減少させる必要があります。

EEPROM.write(0, 100) // 0 means the right motor, 100 means the speed is 100%, can be set to 90, 95, etc., depending on the actual situation. 3.

コードを変更した後、R3ボードにコードをアップロードして効果を確認します。車がほぼまっすぐになるまで上記の手順を繰り返します。
このオフセットは EEPROM に記録されます。他のプロジェクトで使用する際には、このオフセットを読み取るだけでよく、 5. 障害物回避モジュールで遊ぶを例として参照してください。

#include <EEPROM.h>

float leftOffset = 1.0;
float rightOffset = 1.0;

const int A_1B = 5;
const int A_1A = 6;
const int B_1B = 9;
const int B_1A = 10;

const int rightIR = 7;
const int leftIR = 8;

void setup() {
    Serial.begin(9600);

    //motor
    pinMode(A_1B, OUTPUT);
    pinMode(A_1A, OUTPUT);
    pinMode(B_1B, OUTPUT);
    pinMode(B_1A, OUTPUT);

    //IR obstacle
    pinMode(leftIR, INPUT);
    pinMode(rightIR, INPUT);

    leftOffset = EEPROM.read(0) * 0.01;//read the offset of the left motor
    rightOffset = EEPROM.read(1) * 0.01;//read the offset of the right motor
}

void loop() {

    int left = digitalRead(leftIR);   // 0: Obstructed  1: Empty
    int right = digitalRead(rightIR);
    int speed = 150;

    if (!left && right) {
        backLeft(speed);
    } else if (left && !right) {
        backRight(speed);
    } else if (!left && !right) {
        moveBackward(speed);
    } else {
        moveForward(speed);
    }
}

void moveForward(int speed) {
    analogWrite(A_1B, 0);
    analogWrite(A_1A, int(speed * leftOffset));
    analogWrite(B_1B, int(speed * rightOffset));
    analogWrite(B_1A, 0);
}

void moveBackward(int speed) {
    analogWrite(A_1B, speed);
    analogWrite(A_1A, 0);
    analogWrite(B_1B, 0);
    analogWrite(B_1A, speed);
}

void backLeft(int speed) {
    analogWrite(A_1B, speed);
    analogWrite(A_1A, 0);
    analogWrite(B_1B, 0);
    analogWrite(B_1A, 0);
}

void backRight(int speed) {
    analogWrite(A_1B, 0);
    analogWrite(A_1A, 0);
    analogWrite(B_1B, 0);
    analogWrite(B_1A, speed);
}