#include "M5Unified.h"
#include "M5GFX.h"
#include "M5AtomicMotion.h"
M5AtomicMotion AtomicMotion;
void setup()
{
auto cfg = M5.config();
M5.begin(cfg);
M5.Display.setTextColor(GREEN);
M5.Display.setTextDatum(middle_center);
M5.Display.setTextSize(2);
M5.Display.drawString("Atomic Init", M5.Display.width() / 2, M5.Display.height() / 2);
m5::board_t board = M5.getBoard();
uint8_t sda = 0, scl = 0;
if (board == m5::board_t::board_M5AtomLite || board == m5::board_t::board_M5AtomMatrix ||
board == m5::board_t::board_M5AtomEcho) {
sda = 25;
scl = 21;
} else if (board == m5::board_t::board_M5AtomS3 || board == m5::board_t::board_M5AtomS3R ||
board == m5::board_t::board_M5AtomS3Lite || board == m5::board_t::board_M5AtomS3RExt ||
board == m5::board_t::board_M5AtomS3RCam) {
sda = 38;
scl = 39;
}
while (!AtomicMotion.begin(&Wire, M5_ATOMIC_MOTION_I2C_ADDR, sda, scl, 100000)) {
M5.Display.clear();
M5.Display.drawString("Init Fail", M5.Display.width() / 2, M5.Display.height() / 2);
Serial.println("Atomic Motion begin failed");
delay(1000);
}
M5.Display.clear();
M5.Display.drawString("Motion", M5.Display.width() / 2, M5.Display.height() / 2);
Serial.println("Atomic Motion Test");
}
void loop()
{
for (int ch = 0; ch < 2; ch++) {
AtomicMotion.setMotorSpeed(ch, 127);
Serial.printf("Motor Channel %d: %d \n", ch, AtomicMotion.getMotorSpeed(ch));
}
delay(1000);
for (int ch = 0; ch < 2; ch++) {
AtomicMotion.setMotorSpeed(ch, -127);
Serial.printf("Motor Channel %d: %d \n", ch, AtomicMotion.getMotorSpeed(ch));
}
delay(1000);
for (int ch = 0; ch < 2; ch++) {
AtomicMotion.setMotorSpeed(ch, 0);
Serial.printf("Motor Channel %d: %d \n", ch, AtomicMotion.getMotorSpeed(ch));
}
delay(1000);
for (int ch = 0; ch < 4; ch++) {
AtomicMotion.setServoAngle(ch, 180);
Serial.printf("Servo Channel %d: %d \n", ch, AtomicMotion.getServoAngle(ch));
}
delay(1000);
for (int ch = 0; ch < 4; ch++) {
AtomicMotion.setServoAngle(ch, 0);
Serial.printf("Servo Channel %d: %d \n", ch, AtomicMotion.getServoAngle(ch));
}
delay(1000);
}
Atomic Motion Base v1.1
バージョンを使用している場合、現在のバッテリー電圧や動作電流値を読み取ることもできます。#include <M5Unified.h>
#include <M5GFX.h>
#include <M5AtomicMotion.h>
M5AtomicMotion AtomicMotion;
void setup()
{
auto cfg = M5.config();
M5.begin(cfg);
m5::board_t board = M5.getBoard();
uint8_t sda = 0, scl = 0;
if (board == m5::board_t::board_M5AtomLite || board == m5::board_t::board_M5AtomMatrix ||
board == m5::board_t::board_M5AtomEcho) {
sda = 25;
scl = 21;
} else if (board == m5::board_t::board_M5AtomS3 || board == m5::board_t::board_M5AtomS3R ||
board == m5::board_t::board_M5AtomS3Lite || board == m5::board_t::board_M5AtomS3RExt ||
board == m5::board_t::board_M5AtomS3RCam) {
sda = 38;
scl = 39;
}
while (!AtomicMotion.begin(&Wire, M5_ATOMIC_MOTION_I2C_ADDR, sda, scl, 100000)) {
printf("Atomic Motion begin failed\n");
delay(1000);
}
printf("Atomic Motion INA226 Test\n");
}
void loop()
{
float voltage = AtomicMotion.ina226.readBusVoltage();
float current = AtomicMotion.ina226.readShuntCurrent();
printf("voltage: %.2f V\n", voltage);
printf("current: %.2f A\n", current);
delay(1000);
}
AtomS3Rのリセットボタンを長押し(約2秒)すると、内部の緑色LEDが点灯し、ボタンを放すことができます。これでデバイスがダウンロードモードに入り、プログラムを待機します。
Atomic Motion Base v1.1 の電源スイッチを ON
にすると、サーボ/DC モーターの駆動が開始されます。