製品ガイド

Unit Roller485/RollerCAN モーター位置キャリブレーション

エンコーダーのキャリブレーション
Unit Roller485/RollerCAN 内部の磁気エンコーダーは出荷前にキャリブレーションされています。特殊な状況でユーザーがモーターを分解した場合、モーターが正常に回転を開始できないことがあります。その場合は、以下のチュートリアルを参考にモーターエンコーダーを再キャリブレーションしてください。

準備

  1. 底部のボタン A を長押ししてから、Grove ケーブルを接続してデバイスに給電します。
  1. 設定メニューに入り、モーターを回転させて項目を切り替え、デバイスを I2C 動作モードに設定します。
  1. Unit Roller485/RollerCAN を M5 メインコントローラーに接続し、以下の手順を参考にキャリブレーションプログラムを書き込みます。

キャリブレーションの実行

  • キャリブレーションプログラム M5Unit-Roller - encoder_calibration をメインコントローラーに書き込みます。他のコントローラーを使用する場合は、実際に使用する GPIO に応じて RollerI2C.begin(&Wire, 0x64, SDA, SCL, 400000) を調整してください。
cpp
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57
/*
 *SPDX-FileCopyrightText: 2024 M5Stack Technology CO LTD
 *
 *SPDX-License-Identifier: MIT
 */
#include "unit_rolleri2c.hpp"
#include <M5Unified.h>

#define ROLLER_CALIBRATION_DELAY 10000

UnitRollerI2C RollerI2C;  // Create a UNIT_ROLLERI2C object

uint8_t is_roller_valid             = 0;
uint8_t is_roller_calibrated        = 0;
uint32_t roller_start_delay_counter = 0;

void setup()
{
    M5.begin();
    if (RollerI2C.begin(&Wire, 0x64, 21, 22, 400000)) {
        is_roller_valid            = 1;
        roller_start_delay_counter = millis();
    }
}

void loop()
{
    if (is_roller_valid) {
        if (millis() - roller_start_delay_counter < ROLLER_CALIBRATION_DELAY) {
            printf("Calibration will start after %dS\n",
                   (roller_start_delay_counter - (millis() - roller_start_delay_counter)) / 1000);
        } else {
            if (!is_roller_calibrated) {
                printf("Start encoder calibration\n");
                RollerI2C.setOutput(0);
                delay(100);
                RollerI2C.startAngleCal();
                delay(100);
                printf("Calibrationing...\n");
                while (RollerI2C.getCalBusyStatus()) {
                    printf("Calibrationing...\n");
                }
                RollerI2C.updateAngleCal();
                printf("Encoder calibration done\n");
                delay(500);
                RollerI2C.setOutput(0);
                RollerI2C.setMode(ROLLER_MODE_SPEED);
                RollerI2C.setSpeed(240000);
                RollerI2C.setSpeedMaxCurrent(100000);
                RollerI2C.setOutput(1);
                is_roller_calibrated = 1;
            }
        }
    } else {
        printf("No roller485 dectected\n");
    }
}
Page Tools
PDF
On This Page