キャチロボ | K*RISE / 九産大の学生による大学魅力発信プロジェクト Fri, 09 Oct 2026 00:16:00 +0000 ja hourly 1 https://wordpress.org/?v=7.1.3 /wp-content/uploads/2025/05/cropped-アセット-20-32x32.png キャチロボ | K*RISE / 32 32 キャチロボ2025 ロボット紹介 /%e3%82%ad%e3%83%a3%e3%83%81%e3%83%ad%e3%83%9c2025-%e3%83%ad%e3%83%9c%e3%83%83%e3%83%88%e7%b4%b9%e4%bb%8b/ Fri, 09 Oct 2026 00:16:00 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=1895

京都で開催されたキャチロボバトルコンテストに、ロボット工房から「ぶちょー」と「FTFT」の2チームで出場しました。

私はチーム「ぶちょー」としてロボットを製作しました。

このロボットについてご紹介します。

大会概要

一言でいうと、

「お菓子を陳列する競技」

今年のワークはプチアソートでした。

もちろん競技はチョコが入っている状態で行われるので、会場は甘い匂いが漂っていました。

試合は対戦形式で、赤コートと青コートがあります。

コートの色によって、お菓子の陳列先が自身の右側なのか左側なのかと変化します。

シューティングエリアにお菓子を置くと得点が入るわけですが、このようにパッケージが揃うように5つ陳列することで追加のボーナス得点を獲得できます。

つぶれたマーブル

このようにワークを破損させると減点されます。

共通エリアなんて要素もありますが今回はスルーしました。

詳しいルールは公式ホームページをご覧ください。

【公式】キャチロボバトルコンテストWEBサイト
キャチロボバトルコンテストはマテリアルハンドリング技術 (マテハン)に特化した学生限定の一般的なロボコンと一線を画すユニークな大会です。

結果報告

予選敗退でしたが、特別枠で紹介いただきました。

第15回キャチロボバトルコンテスト・ライブ配信
日程:2025年9月21日(日)12時~会場:京都国際会館イベントホール○キャチロボバトルコンテストについてキャチロボバトルコンテストは、京都工芸繊維大学・ロボコン挑戦プロジェクト、 立命館大学・ロボット技術研究会、大阪大学・Robohan...

予選試合1回目は38点

予選試合2回目は15点

敗因は後ほど。

機構

デデーン

自画自賛になりますが、かっこいいです。

どことなく要塞のような、ずっしりとした佇まいです。

このロボットには大きく3つの機構が搭載されています。

1.メインアーム

5種類のワークを1つずつ。計5つを同時に回収して中央にまとめます。

XYZ軸の直動機構で構成されており、横のシューティングエリアには関与しません。

初めからボーナス得点を狙っていたため、中央によせる機構をメインに考えていました。

試作は木材です。

このマジックハンド機構は関節が多く、精度が悪くなりやすいというデメリットがあります。

できる限り実用性を追求したかったので1ヶ所の関節につき4枚のベアリングをいれています。

とは言っても、穴あけをボール盤で行っているため穴間距離はバラつきがありました。

レールにはアルミフレーム(V-slot)を使っています。

メインアームの前後駆動はラック&ピニオン機構です。

ロボマスモーターの減速比が少し大きかったためピニオンギアの直径を大きく設けています。

ラック側はT2のジュラルミン板を切削して作りました。

時間とお金と労力がかかっています。たぶんフレキラックで十分でした。

ちなみに、CNCで歯車を削り出す場合はモジュール2.5を採用しています。∅3のエンドミルで切削が可能であるためです。

Z軸は前後駆動(Y軸)の先端についています。

サーボモーターで動かしており、上から定荷重ばねで吊っています。

後ろ側に基板スペースを設けています。

各アクチュエータに基板が内蔵されているような構成なので省スペース。

2.サブアーム

Y軸と4軸アームで構成されています。

ボーナス得点を獲得するために棚へ陳列する動作を行います。

スローで撮影

3.パスアーム

メインアームで回収されたワークを乗せてサブアームにパスします。

このとき遠心力と慣性を使うことで整頓も行います。

苦肉の策で作った機構でしたが、かなり良いものに仕上がりました。

回路

ArduinoUNOを中心に構成しています。

無線と画面表示をM5stuck(I2C通信)

ロボマス用のCAN通信をMCP2515(SPI通信)

近藤科学のサーボはスレーブモードに(UART)

処理能力的にはあまり余裕が無さそうですね

プログラム

基本的にコントローラーの入力に応じた処理をするだけだったのでシンプルです。

2025_kyati_uno

#include <Wire.h>

#include <IcsBaseClass.h>

#include <IcsHardSerialClass.h>

#include “config.h”

#include “receiveEvent.h”

#include “displayReceivedData.h”

#include “robomas.h”

const int mos = 3;  //真空ポンプ

const byte EN_PIN = 4;  //いらないが消すとエラー

const long BAUDRATE = 115200;

const int TIMEOUT = 3;                                       //魔の数字(送信間隔)

IcsHardSerialClass krs(&Serial, EN_PIN, BAUDRATE, TIMEOUT);  //インスタンス+ENピンおよびUARTの指定

float a = 7500 + 320;  //0 主x

float b = 7500 – 320;  //1 主x

int c = 11250;         //2 主Z

int d = 7500;          //3 サブZ

int e = 7500;          //4 サブx

int g = 7500;          //6 サブ先端

int h = 7800;          //7 サブ先端縦8100

int j = 10500;         //8 パス

int k = 4150;          //9 パス

int haba = 1;  //広く

int taka = 1;  //高さ

int pasu = 0;  //パス

float ha, hb;  //主X 1ステップの値を格納

void setup() {

  Wire.begin(8);  // I2Cアドレスを8に設定

  Wire.onReceive(receiveEvent);

  //Serial.begin(115200);

  krs.begin();  //サーボモータの通信初期設定

  C610::begin();

  pinMode(mos, OUTPUT);

}

void loop() {

  /*構成

  初期化

  メインY

  メインZ

  メインX横

  メインX幅

  サブX

  サブY

  サブZ

  吸着機構

  パス機構

  サブ受取モーション

  サブ設置モーション

  */

  if (dataReceived) {               //データ受け取ってたら

    if (receivedHou == 2) {         //赤コート

      if (receivedPSButton == 1) {  //初期状態に

        a = 7500 + 320;             //0

        b = 7500 – 320;             //1

        c = 11250;                  //2

        j = 10500;                  //8 パス

        pasu = 0;

        krs.setPos(2, c);

        unsigned long start = millis();

        while (millis() – start < 1000) {

          C610::put(1, 2500);

          //C610::put(2, -750);

          C610::send();

        }

      }

      if (receivedRightStickY > 135) {  //主Y

        C610::put(1, map(receivedRightStickY, 135, 225, 0, -10000));

      } else if (receivedRightStickY < 120) {

        C610::put(1, map(receivedRightStickY, 120, 0, 0, 10000));

      } else {

        C610::put(1, 0);

      }

      if (receivedTriangleButton == 1) {  //主Z

        taka = 1;

        c = 11250;  //上方向

      } else if (receivedCrossButton == 1) {

        if (taka == 1) {

          taka = 2;

          c = 4100;  //下方向

          delay(200);

        } else if (taka == 2) {

          c -= 100;

          delay(100);

        }

      }

      if (receivedR2Value > 225) {  //主X横左右選択

        a = 7500 + 20;

        b = 7500 – 620;

        delay(200);

      } else if (receivedL2Value > 225) {

        a = 7500 + 700;

        b = 7500 + 60;

        delay(200);

      } else if (receivedR2Value > 10 && a > 3500 && b > 3500) {  //主X横微調節

        a -= map(receivedR2Value, 10, 255, 1, 40);

        b -= map(receivedR2Value, 10, 255, 1, 40);

      } else if (receivedL2Value > 10 && a < 11500 && b < 11500) {

        a += map(receivedL2Value, 10, 255, 1, 40);

        b += map(receivedL2Value, 10, 255, 1, 40);

      }

      if (receivedR1Button == 1) {  //主X幅

        if (haba == 1) {            //狭める

          haba = 0;

          ha = (a – 6300) / 300;  //6500

          hb = (b – 8300) / 300;  //8500

          for (int i = 0; i < 300; i++) {

            a -= ha;

            b -= hb;

            krs.setPos(0, a);

            krs.setPos(1, b);

            delay(1);

          }

        } else {  //広げる

          haba = 1;

          ha = (a – (7500 + 320)) / 100;

          hb = (b – (7500 – 320)) / 100;

          for (int i = 0; i < 100; i++) {

            a -= ha;

            b -= hb;

            krs.setPos(0, a);

            krs.setPos(1, b);

            delay(1);

          }

        }

      }

      if (receivedLeftStickX > 155) {  //サブX

        e -= map(receivedLeftStickX, 155, 225, 0, 200);

      } else if (receivedLeftStickX < 100) {

        e += map(receivedLeftStickX, 100, 0, 0, 200);

      }

      if (receivedLeftStickY > 135) {  //サブY

        C610::put(2, map(receivedLeftStickY, 135, 225, 0, 6384));

      } else if (receivedLeftStickY < 120) {

        C610::put(2, map(receivedLeftStickY, 120, 0, 0, -6384));

      } else {

        C610::put(2, 0);

      }

      if (receivedUpButton == 1) {  //サブZ

        d = 9000;

      } else if (receivedDownButton == 1) {

        d = 4000;

      }

      if (receivedCircleButton == 1) {  //吸着

        digitalWrite(mos, HIGH);

      } else if (receivedSquareButton == 1) {

        digitalWrite(mos, LOW);

        if (haba == 0) {  //自動パス

          delay(250);

          j = 4850;

          krs.setPos(8, j);

          delay(750);

          j = 10205;  //戻る

          krs.setPos(8, j);

        }

      }

      if (receivedL1Button == 1) {  //パス機構

        if (pasu == 0) {            //受取状態へ

          pasu = 1;

          j = 10205;

          delay(200);

        } else if (pasu == 1) {  //パス状態へ

          pasu = 2;

          j = 4850;

          delay(200);

        } else if (pasu == 2) {  //受取状態へ

          pasu = 1;

          j = 10205;

          delay(200);

        }

      }

      if ((receivedLeftButton == 1 && g == 7500) || (receivedRightButton == 1 && g == 7500)) {  //受取角度

        d = 4000;

        krs.setPos(3, d);  //下げる

        e = 7500;

        krs.setPos(4, e);  //引く

        h = 7800;

        krs.setPos(7, h);  //浅く(角度)

        delay(250);

        g = 10200;

        krs.setPos(6, g);

        delay(250);

        e = 11500;

        krs.setPos(4, e);

      } else if ((receivedLeftButton == 1 && g == 10200) || (receivedRightButton == 1 && g == 10200)) {

        h = 8500;

        krs.setPos(7, h);  //深く(角度)

        e = 7500;

        krs.setPos(4, e);

        delay(250);

        g = 7500;

        krs.setPos(6, g);

        delay(250);

      }

      if (receivedTouchPadButton == 1) {  //置く

        krs.setPos(4, e + 1700);          //奥へ

        delay(250);

        krs.setPos(3, d + 2200);  //スライドさせる

        krs.setPos(7, h – 1500);

        delay(700);

        for (int i = 7000; i <= 7800; i += 20) {  //ゆっくり起こす

          krs.setPos(7, i);

          delay(1);

        }

        e = 7500;

        krs.setPos(4, e);

        delay(250);

        d = 4000;

        krs.setPos(3, d);  //下げる

        h = 7800;

        krs.setPos(7, h);  //浅く(角度)

        delay(250);

        g = 10200;

        krs.setPos(6, g);

        delay(250);

        e = 11500;

        krs.setPos(4, e);

      }

      if (receivedShareButton == 1) {

        h = 6500;

      }

      krs.setPos(0, a);

      krs.setPos(1, b);

      krs.setPos(2, c);

      krs.setPos(3, d);

      krs.setPos(4, e);

      krs.setPos(6, g);

      krs.setPos(7, h);

      krs.setPos(8, j);  //iはfor文で使う

      C610::send();

    } else if (receivedHou == 1) {  //青コート

      if (receivedPSButton == 1) {  //初期状態に

        a = 7500 + 320;             //0

        b = 7500 – 320;             //1

        c = 11250;                  //2

        k = 4300;                  //8 パス

        pasu = 0;

        krs.setPos(2, c);

        unsigned long start = millis();

        while (millis() – start < 1000) {

          C610::put(1, 2500);

          //C610::put(2, -750);

          C610::send();

        }

      }

      if (receivedRightStickY > 135) {  //主Y

        C610::put(1, map(receivedRightStickY, 135, 225, 0, -10000));

      } else if (receivedRightStickY < 120) {

        C610::put(1, map(receivedRightStickY, 120, 0, 0, 10000));

      } else {

        C610::put(1, 0);

      }

      if (receivedTriangleButton == 1) {  //主Z

        taka = 1;

        c = 11250;  //上方向

      } else if (receivedCrossButton == 1) {

        if (taka == 1) {

          taka = 2;

          c = 4100;  //下方向

          delay(200);

        } else if (taka == 2) {

          c -= 100;

          delay(100);

        }

      }

      if (receivedR2Value > 225) {  //主X横左右選択 間640

        a = 7500 – 106;//-106

        b = 7500 – 734;//-734

        delay(200);

      } else if (receivedL2Value > 225) {

        a = 7500 + 616;//616

        b = 7500 – 36;//-36

        delay(200);

      } else if (receivedR2Value > 10 && a > 3500 && b > 3500) {  //主X横微調節

        a -= map(receivedR2Value, 10, 255, 1, 40);

        b -= map(receivedR2Value, 10, 255, 1, 40);

      } else if (receivedL2Value > 10 && a < 11500 && b < 11500) {

        a += map(receivedL2Value, 10, 255, 1, 40);

        b += map(receivedL2Value, 10, 255, 1, 40);

      }

      if (receivedR1Button == 1) {  //主X幅

        if (haba == 1) {            //狭める

          haba = 0;

          ha = (a – 6300) / 300;  //6500

          hb = (b – 8300) / 300;  //8500

          for (int i = 0; i < 300; i++) {

            a -= ha;

            b -= hb;

            krs.setPos(0, a);

            krs.setPos(1, b);

            delay(1);

          }

        } else {  //広げる

          haba = 1;

          ha = (a – (7500 + 320)) / 100;

          hb = (b – (7500 – 320)) / 100;

          for (int i = 0; i < 100; i++) {

            a -= ha;

            b -= hb;

            krs.setPos(0, a);

            krs.setPos(1, b);

            delay(1);

          }

        }

      }

      if (receivedLeftStickX > 155) {  //サブX

        e -= map(receivedLeftStickX, 155, 225, 0, 200);

      } else if (receivedLeftStickX < 100) {

        e += map(receivedLeftStickX, 100, 0, 0, 200);

      }

      if (receivedLeftStickY > 135) {  //サブY

        C610::put(2, map(receivedLeftStickY, 135, 225, 0, 6384));

      } else if (receivedLeftStickY < 120) {

        C610::put(2, map(receivedLeftStickY, 120, 0, 0, -6384));

      } else {

        C610::put(2, 0);

      }

      if (receivedUpButton == 1) {  //サブZ

        d = 9000;

      } else if (receivedDownButton == 1) {

        d = 4000;

      }

      if (receivedCircleButton == 1) {  //吸着

        digitalWrite(mos, HIGH);

      } else if (receivedSquareButton == 1) {

        digitalWrite(mos, LOW);

        if (haba == 0) {  //自動パス

          delay(250);

          k = 9800;

          krs.setPos(9, k);

          delay(750);

          k = 4550;  //戻る

          krs.setPos(9, k);

        }

      }

      if (receivedL1Button == 1) {  //パス機構

        if (pasu == 0) {            //受取状態へ

          pasu = 1;

          k = 4550;

          delay(200);

        } else if (pasu == 1) {  //パス状態へ

          pasu = 2;

          k = 9800;

          delay(200);

        } else if (pasu == 2) {  //受取状態へ

          pasu = 1;

          k = 4550;

          delay(200);

        }

      }

      if ((receivedLeftButton == 1 && g == 7500) || (receivedRightButton == 1 && g == 7500)) {  //受取角度

        d = 4000;

        krs.setPos(3, d);  //下げる

        e = 9500;

        krs.setPos(4, e);  //引く

        h = 7800;

        krs.setPos(7, h);  //浅く(角度)

        delay(250);

        g = 4900;

        krs.setPos(6, g);

        delay(250);

        e = 4600;

        krs.setPos(4, e);

      } else if ((receivedLeftButton == 1 && g == 4900) || (receivedRightButton == 1 && g == 4900)) {

        h = 8500;

        krs.setPos(7, h);  //深く(角度)

        e = 9500;

        krs.setPos(4, e);

        delay(250);

        g = 7500;

        krs.setPos(6, g);

        delay(250);

      }

      if (receivedTouchPadButton == 1) {  //置く

        krs.setPos(4, e – 1700);          //奥へ

        delay(250);

        krs.setPos(3, d + 2200);  //スライドさせる 1500よりもいい

        krs.setPos(7, h – 1500);

        delay(700);

        for (int i = 7000; i <= 7800; i += 20) {  //ゆっくり起こす

          krs.setPos(7, i);

          delay(1);

        }

        e = 9500;

        krs.setPos(4, e);

        delay(250);//ここまで置く動作

        d = 4000;

        krs.setPos(3, d);  //下げる

        e = 9500;

        krs.setPos(4, e);  //引く

        h = 7800;

        krs.setPos(7, h);  //浅く(角度)

        delay(250);

        g = 4900;

        krs.setPos(6, g);

        delay(250);

        e = 4600;

        krs.setPos(4, e);

      }

      if (receivedShareButton == 1) {

        h = 6500;

      }

      krs.setPos(0, a);

      krs.setPos(1, b);

      krs.setPos(2, c);

      krs.setPos(3, d);

      krs.setPos(4, e);

      krs.setPos(6, g);

      krs.setPos(7, h);

      krs.setPos(9, k);

      C610::send();

    }

  }

  displayReceivedData();

}

config.h

int oldreceivedLeftStickY;

int oldreceivedLeftStickX;

bool receivedRightButton;

bool receivedDownButton;

bool receivedUpButton;

bool receivedLeftButton;

bool receivedSquareButton;

bool receivedCrossButton;

bool receivedCircleButton;

bool receivedTriangleButton;

bool receivedL1Button;

bool receivedR1Button;

bool receivedShareButton;

bool receivedOptionsButton;

bool receivedL3Button;

bool receivedR3Button;

bool receivedPSButton;

bool receivedTouchPadButton;

int receivedL2Value;

int receivedR2Value;

int receivedLeftStickX;

int receivedLeftStickY;

int receivedRightStickX;

int receivedRightStickY;

volatile int receivedHou;

volatile int receivedCustom;

volatile bool dataReceived = false;

displayReceivedData.h

void displayReceivedData() {

  // 受信したデータをシリアルモニターに表示

  /*Serial.print(” Buttons: “);

  Serial.print(“→: “);

  Serial.print(receivedRightButton);

  Serial.print(” ↓: “);

  Serial.print(receivedDownButton);

  Serial.print(” ↑: “);

  Serial.print(receivedUpButton);

  Serial.print(” ←: “);

  Serial.print(receivedLeftButton);

  Serial.print(” □: “);

  Serial.print(receivedSquareButton);

  Serial.print(” ✕: “);

  Serial.print(receivedCrossButton);

  Serial.print(” ❍: “);

  Serial.print(receivedCircleButton);

  Serial.print(” △: “);

  Serial.print(receivedTriangleButton);

  Serial.print(” L1: “);

  Serial.print(receivedL1Button);

  Serial.print(” R1: “);

  Serial.print(receivedR1Button);

  Serial.print(” Share: “);

  Serial.print(receivedShareButton);

  Serial.print(” Options: “);

  Serial.print(receivedOptionsButton);

  Serial.print(” L3: “);

  Serial.print(receivedL3Button);

  Serial.print(” R3: “);

  Serial.print(receivedR3Button);

  Serial.print(” PS: “);

  Serial.print(receivedPSButton);

  Serial.print(” TouchPad: “);

  Serial.print(receivedTouchPadButton);*/

  //—————————————————————————————

  if (receivedLeftStickY == 255) {  //変換(?)

    if (oldreceivedLeftStickY <= 125) {

      receivedLeftStickY = 0;

    }

  }

  oldreceivedLeftStickY = receivedLeftStickY;

  if (receivedLeftStickX == 255) {

    if (oldreceivedLeftStickX <= 125) {

      receivedLeftStickX = 0;

    }

  }

  oldreceivedLeftStickX = receivedLeftStickX;

  /*Serial.print(“L2Value: “);

  Serial.print(receivedL2Value);

  Serial.print(” R2Value: “);

  Serial.print(receivedR2Value);

  Serial.print(“左X: “);

  Serial.print(receivedLeftStickX);

  Serial.print(” 左Y: “);

  Serial.print(receivedLeftStickY);

  Serial.print(” 右X: “);

  Serial.print(receivedRightStickX);

  Serial.print(” 右Y: “);

  Serial.print(receivedRightStickY);

  Serial.print(” 方向: “);

  Serial.print(receivedHou);

  Serial.print(” カスタム: “);

  Serial.println(receivedCustom);*/

  /*Serial.print(” ID1:”);

  Serial.print(” 角度”);

  Serial.print(C610::getAngle(1));

  Serial.print(” 速度”);

  Serial.print(C610::getVelocity(1));

  Serial.print(” ID2:”);

  Serial.print(” 角度”);

  Serial.print(C610::getAngle(2));

  Serial.print(” 速度”);

  Serial.print(C610::getVelocity(2));

  Serial.println(” “);*/

}

receiveEvent.h

void receiveEvent() {

  if (Wire.available() >= 24) {  // 16ボタン + 4スティック + 2トリガーボタンのデータ+2自由値

    // ボタンの状態を変数に代入

    receivedRightButton = Wire.read() == 1;

    receivedDownButton = Wire.read() == 1;

    receivedUpButton = Wire.read() == 1;

    receivedLeftButton = Wire.read() == 1;

    receivedSquareButton = Wire.read() == 1;

    receivedCrossButton = Wire.read() == 1;

    receivedCircleButton = Wire.read() == 1;

    receivedTriangleButton = Wire.read() == 1;

    receivedL1Button = Wire.read() == 1;

    receivedR1Button = Wire.read() == 1;

    receivedShareButton = Wire.read() == 1;

    receivedOptionsButton = Wire.read() == 1;

    receivedL3Button = Wire.read() == 1;

    receivedR3Button = Wire.read() == 1;

    receivedPSButton = Wire.read() == 1;

    receivedTouchPadButton = Wire.read() == 1;

    // トリガーボタンのアナログ値を変数に代入

    receivedL2Value = Wire.read();

    receivedR2Value = Wire.read();

    // スティックの値を変数に代入

    receivedLeftStickX = Wire.read();

    receivedLeftStickY = Wire.read();

    receivedRightStickX = Wire.read();

    receivedRightStickY = Wire.read();

    //自由値を変数に代入

    receivedHou = Wire.read() | (Wire.read() << 8);

    receivedCustom = Wire.read() | (Wire.read() << 8);

    dataReceived = true;//受信フラグ

  }

}

robomas.cpp

// robomas.cpp

#include “robomas.h”

#define PI 3.14

MCP_CAN CAN0(SS_Robomas_C610);

uint16_t C610::current_max[8] = {16384, 16384, 16384, 16384, 16384, 16384, 16384, 16384};

uint8_t C610::buf_0x200[8] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};

uint8_t C610::buf_0x1FF[8] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};

int C610::received_angle[8] = {0, 0, 0, 0, 0, 0, 0, 0};

int16_t C610::received_velocity[8] = {0, 0, 0, 0, 0, 0, 0, 0};

int16_t C610::received_torque_current[8] = {0, 0, 0, 0, 0, 0, 0, 0};

// — 追加: 累積位置用変数 —

static long encoder_pos[8] = {0};

static int last_angle[8]   = {0};

void C610::begin()

{

    CAN0.begin(MCP_ANY, CAN_bps, MCP_OSC);

    if (CAN0.begin(MCP_ANY, CAN_bps, MCP_OSC) == CAN_OK)

    {

        //Serial.println(“Success : MCP2515 Initialization”);

    }

    else

    {

        //Serial.println(“Fail : MCP2515 Initialization”);

    }

    delay(100);

    CAN0.setMode(MCP_NORMAL);

}

void C610::setMaxCurrent(unsigned int C610_id, uint16_t max)

{

    if (1 <= C610_id && C610_id <= 8 && 0 <= max && max <= 10000)

    {

        C610::current_max[C610_id – 1] = max;

        return;

    }

    //Serial.println(“Fail : id or max is out of range.”);

}

void C610::put(unsigned int C610_id, double current)

{

    if (abs(current) > current_max[C610_id – 1])

    {

        //Serial.println(“Fail :  current value is out of range.”);

        return;

    }

    int16_t converted = static_cast<int16_t>(current);

    uint8_t high_byte = (converted >> 8) & 0xFF;

    uint8_t low_byte = converted & 0xFF;

    if (1 <= C610_id && C610_id <= 4)

    {

        buf_0x200[(C610_id – 1) * 2] = high_byte;

        buf_0x200[(C610_id – 1) * 2 + 1] = low_byte;

        return;

    }

    if (5 <= C610_id && C610_id <= 8)

    {

        buf_0x1FF[(C610_id – 5) * 2] = high_byte;

        buf_0x1FF[(C610_id – 5) * 2 + 1] = low_byte;

        return;

    }

    //Serial.println(“Fail :  C610_id is out of range.”);

}

void C610::send()

{

    CAN0.sendMsgBuf(0x200, 0, 8, buf_0x200);

    CAN0.sendMsgBuf(0x1FF, 0, 8, buf_0x1FF);

}

void C610::print(bool hex_flag)

{

    for (int i = 1; i < 9; i++)

    {

        int16_t value;

        uint8_t high_byte;

        uint8_t low_byte;

        if (1 <= i && i <= 4)

        {

            high_byte = buf_0x200[(i – 1) * 2];

            low_byte = buf_0x200[(i – 1) * 2 + 1];

        }

        if (5 <= i && i <= 8)

        {

            high_byte = buf_0x1FF[(i – 5) * 2];

            low_byte = buf_0x1FF[(i – 5) * 2 + 1];

        }

        value = (high_byte << 8) + low_byte;

        //if (hex_flag)

            //Serial.print(value, HEX);

        //else

            //Serial.print(value);

        //Serial.print(” “);

    }

    //Serial.println();

}

void C610::receive()

{

    if (CAN_MSGAVAIL == CAN0.checkReceive())

    {

        for (int i = 1; i < 9; i++)

        {

            uint8_t len = 0;

            uint8_t data[8];

            unsigned long int rx_message;

            CAN0.readMsgBuf(&rx_message, &len, data);

            if (rx_message == 0x200 + i)

            {

                received_angle[i – 1] = (data[0] << 8) + data[1];

                received_velocity[i – 1] = (data[2] << 8) + data[3];

                received_torque_current[i – 1] = (data[4] << 8) + data[5];

            }

        }

    }

}

double C610::getAngle(unsigned int C610_id)

{

    if (C610_id < 1 || 8 < C610_id)

    {

        //Serial.print(“Fail : id is out of range.”);

        return -1;

    }

    double angle = (double)received_angle[C610_id – 1] / 8191 * 2 * PI;

    return angle;

}

int16_t C610::getVelocity(unsigned int C610_id)

{

    if (C610_id < 1 || 8 < C610_id)

    {

        //Serial.print(“Fail : id is out of range.”);

        return -1;

    }

    return received_velocity[C610_id – 1];

}

int16_t C610::getTorqueCurrent(unsigned int C610_id)

{

    if (C610_id < 1 || 8 < C610_id)

    {

        //Serial.print(“Fail : id is out of range.”);

        return -1;

    }

    return received_torque_current[C610_id – 1];

}

robomas.h

//robomas.h

//C610_引数のidはC610に割り振られたidであることに注意。(1から始まる)

#ifndef ROBOMAS_H

#define ROBOMAS_H

#include <SPI.h>

#include <mcp_can.h>

#define SS_Robomas_C610 10 // SPI通信に用いるピン

extern MCP_CAN CAN0;

const int CAN_bps = CAN_1000KBPS; // 変更可

const int MCP_OSC = MCP_8MHZ;     // 回路上の発振子と合わせる

class C610

{

public:

    // 動作電流値の最大値のデータ

    // これを超える電流値を流そうとしても反映されない。

    static uint16_t current_max[8]; // = {10000, 10000, 10000, 10000, 10000, 10000, 10000, 10000};

    // C610に送信するデータ

    static uint8_t buf_0x200[8]; // = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};

    static uint8_t buf_0x1FF[8]; // = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};

    // 受け取ったモーターの角度を格納する変数

    // 格納されているのは0 ~ 8191の範囲の整数でそれぞれ0 ~ 2π radに対応している。

    static int received_angle[8]; // = {0, 0, 0, 0, 0, 0, 0, 0};

    // 受け取ったモーターの速度を格納する変数

    // 単位は rpm

    static int16_t received_velocity[8]; // = {0, 0, 0, 0, 0, 0, 0, 0};

    // 受け取ったモーターの実際のトルク電流を格納する変数

    // 単位は mA

    static int16_t received_torque_current[8]; // = {0, 0, 0, 0, 0, 0, 0, 0};

    // 初期化関数

    static void begin();

    // 電流値の最大値を設定する。

    static void setMaxCurrent(unsigned int C610_id, uint16_t max);

    // idに対して動作電流値を設定する。

    // 電流値の範囲は-10000mA~10000mA

    // PID制御しやすいようにdouble型を引数としているが16bitの整数に変換されるため小数点以下は反映されない。

    static void put(unsigned int C610_id, double current);

    // CAN通信でデータを送信。

    static void send();

    // 指示している電流値を読み取る。

    // 引数をtrueにすると16進数4桁で表示される。

    // falseにすると10進数で表示される。

    static void print(bool hex_flag = true);

    // C610からデータを受け取る

    static void receive();

    // モーターの角度を取得

    // 機械角度範囲:0~2π

    // 単位 rad

    static double getAngle(unsigned int C610_id);

    // モーター回転速度を取得

    // 単位 rpm

    static int16_t getVelocity(unsigned int C610_id);

    // 実際のトルク電流を取得

    // 単位 mA

    static int16_t getTorqueCurrent(unsigned int C610_id);

};

#endif

操縦がとても大変でした。

敗因

いままでに比べて、本当に些細なことで負けた気がします。

青コートの時、サブアームのY軸を駆動するモーターが干渉してしまっていました。
これにより10mm左に機体を設置することとなり、サブアームのX軸可動域が不足してしまいました。

CADをもっと作りこむか、練習環境を再現できていれば…

予選2試合目にサブアームの歯車がメインアームの配線を絡めとり引き抜かれました。
抜けた配線は差すだけで復旧できる状態でしたが、メンテナンス性を考慮していない設計により、その場での修正が困難でなすすべなく3分間を終えました。

まとめ

ロボットの性能を十分に発揮してやれなかったことが、ロボットに対して申し訳ないと思ってます。
悔しすぎる…

とは言いつつ、特別枠で紹介いただけたのでとても嬉しかったです。

来年は本気で優勝を目指します。

それでは、またいつか。

]]>
高級モーター開拓記 /%e9%ab%98%e7%b4%9a%e3%83%a2%e3%83%bc%e3%82%bf%e3%83%bc%e9%96%8b%e6%8b%93%e8%a8%98/ /%e9%ab%98%e7%b4%9a%e3%83%a2%e3%83%bc%e3%82%bf%e3%83%bc%e9%96%8b%e6%8b%93%e8%a8%98/#respond Wed, 07 Oct 2026 00:00:00 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=4475

以前、「買ってよかったもの」というテーマで執筆した記事でロボマスモーターを紹介しました。

しかし、こちらでご紹介したロボマスモーターは導入から数ヵ月後に在庫切れとなり、そのまま補充されず入手困難となっています。

せっかく使いやすくて重宝していたのに…

ということで、新しいモーターを開拓してみます。

(学生広報と称して関係のない内容を記事にしていますが、記事の母数が増えるのは良いことなので許してもらえるはず…)

スペック

今回、導入するモーターはこちら!!!

ゴツくてカッコイイ!

そこそこにずっしりしてます。

分厚い装甲に覆われているようで、多少雑に扱っても壊れなさそうです

モーターは「NEO Brushless Motor V1.1」

スペックはサイト内に記載されている通りなのですが、注目すべき点をピックアップしておきます
・重量 0.425kg
・電圧 12 V
・電流(ピーク) 105 A
・トルク 2.6 Nm
・回転数 5676 RPM
・軸 φ8(キー溝)
・取り付け穴 #10-32 

トルクは少し低めですが、圧倒的な回転数でカバーできそうです。
12V駆動というのが少々トレンドから外れていますね
最大の落とし穴は取り付け穴の規格です。

制御回路は「SPARK MAX Motor Controller」

・対象 ブラシ付き、ブラシレスDCモーター
・電圧 5.5V – 24V
・電流(連続) 60A
・電流(瞬間) 100A(2秒間)
・制御方式 PWM,CAN,USB

ブラシ付き、ブラシレス両方いけるドライバって珍しくないですか!?
定格電力的にもほとんどのモーターは問題なく使えそうです(735モーターは無理か…)
制御方式はPWMだと確実に動きますが、制御回路内でのPID制御を発動できないので基本的にはCAN通信を使うことになりそうです。

使い方(機構)

モーターの取り付けネジは#10-32です。

これはインチ規格ではなくユニファイ規格です。

アメリカンですねぇー

一応、M5タップを無理やり掘って固定できるそうですが、私はこの手法を信用していません。

頑張って、ネジ専門店で購入しました。

(専門店でも在庫が少なく、希望の長さがなかったため旋盤で短くしました)

軸関連は純正のアクセサリーを購入すると楽で確実です。

純正品をケチった場合の固定法を軽く説明します。

軸は∅8で2mmのキー溝が掘ってあります。
手元にキー溝のある歯車がなかったので∅2のエンドミルで追加工しています。
キーには2mm厚のジュラルミン板を突っ込みました。
軸の先端に#10-32規格でタップが掘ってあるのでこの穴を活用して抜け止めします。
更にイモネジで上下の動きを拘束して完成です。

大変でした…

使い方(回路)

まず、モーターの線や制御回路側の線にコネクタをつけます。

純正だと高いので今回は適当なバナナプラグを付けました。

電源線にはXT60コネクタを付けましたが定格を考慮すると微妙な気がします。
バッテリー側の放電能力から我々の環境では問題なさそうです。

モーターから出ている信号線は確実に制御回路側につなげましょう。
押し込みすぎると接触不良になります。
線が抜けるとモーターが焦げ付くらしいので気を付けましょう。

CANで動かす場合は終端抵抗510Ωくらいを探ってみてください

ちなみに、モーターから出ている信号線のうち、黄色と青色がエンコーダの線になっています。

黒色の線(GND)と合わせて分岐することで直接的な回転数を読み取れますが分解能が低い上、電源を投入した後に有効になる仕様だったのでおすすめしません。

使い方(プログラム)

ここが一番厄介です。

まず、制御回路の専用ソフトとプログラムの内容を一致させる必要があります。

専用ソフトのダウンロードページはこちら。
Installation | REV Hardware Client | REV Robotics Documentation

起動するとこのような画面になります。

USBケーブルでPCとSPARK MAX Motor Controllerをつなぐと以下の表示になります。
このときCAN通信の線にマイコンなどを繋いでいると認識されない場合があります。

表示された機器をクリックすると、メイン画面が開きます。
ここでは電流保護の値からリミットスイッチの有無、警告などを設定・確認することができます。

最も注意すべき点は、「ブラシレスモーターをブラシ付きモーターのモードで使わないようにすること」です。
壊れるらしい。

Runのタブでは速度制御や位置制御を実行して動作確認をすることができます。
結線や設定に問題のないことを確認したら、動かしてみましょう。
ここで動けば第一関門突破です。

私の環境ではモーターの信号線を制御回路に接続する部分で押し込みすぎて接触不良が発生しました。

↓専用ソフトから位置制御したときの様子です。

めっちゃ速く1回転を繰り返しています。
感動しちゃいますね

1回転を1、半回転を0.5と表現されていますが0.01単位でも余裕そうです。

スペック上の表記ではエンコーダが42分割と書かれていましたが、位置制御にこのエンコーダは使っていないのでしょうか?
とにかく期待以上でよかった。

↓マイコンからPWM信号で動かしてみました。(デューティー比は1000~ 2000です)

問題なく動きました。

プログラム

#include <M5Stack.h>

#include <ESP32Servo.h>

Servo sparkMax;

void setup() {

  sparkMax.attach(26, 1000, 2000);

  sparkMax.writeMicroseconds(1500);  // 初期停止

  delay(3000);

}

void loop() {

  /*

  sparkMax.writeMicroseconds(1500);//停止

  sparkMax.writeMicroseconds(1000);//正転(最大)

  sparkMax.writeMicroseconds(2000);//逆転(最大)

  */

  sparkMax.writeMicroseconds(1400);

  delay(500);

  sparkMax.writeMicroseconds(1500);

  delay(500);

  sparkMax.writeMicroseconds(1600);

  delay(500);

  sparkMax.writeMicroseconds(1500);

  delay(500);

}

CAN通信で動かす資料が少なく、実例も見当たらなかったのでエンコーダの線を分岐してマイコンから直接PID制御をかけてみることにしました。

正直、実用レベルにはなりませんでした。

原因は
・エンコーダの分解能が足りない
・PWM制御に対する応答性が良くない
・正逆転の性能が異なる
あたりだと思います

↓自作の位置制御が一番うまくいったときの様子です
減速比が大きければ使えなくもない…?レベルでした。

せっかく内部でPID制御を効かせる機能があるのに使わないのはもったいないですよね
頑張って使えるようにする方法を見つけました。

参考:https://www.chiefdelphi.com/t/non-frc-spark-max-can-control/468856

上記のサイト内にあるGoogleドライブにあるコードの一部を編集して使いました。
ジョセフさんありがとうございます。
1週間を費やして調べてみたところ、この情報以外見つかりませんでした。

マイコンのCANからSparkMaxを動かすには、まずファームウェアのバージョンを落とします。
1.5.0くらいだったと思います。
忘れたので動かなければ総当たりしてみてください。

モーターの制御方式とプログラム上の制御方式を一致させます
↓こちらから設定します。今回は単純な位置制御を選択しました。

以上の内容を設定し終えたらマイコンのコードを書いて実行するだけです。

マイコンはESP32-wroom

CANトランシーバーはSN65HVD230を使いました

コード(メイン)

#include “driver/twai.h”        //v1.0.1

void setup() {

  // put your setup code here, to run once:

  init_can();  //SparkMax初期化

}

void loop() {

  // put your main code here, to run repeatedly:

  SparkMax(1.00);

}

SparkMax.ino

#include “driver/twai.h”

unsigned long lastSendTime = 0; // 20ms送信タイマー

void init_can() { // CAN初期化

  twai_general_config_t g_cfg = TWAI_GENERAL_CONFIG_DEFAULT(GPIO_NUM_17, GPIO_NUM_16, TWAI_MODE_NORMAL);

  twai_timing_config_t t_cfg = TWAI_TIMING_CONFIG_1MBITS();

  twai_filter_config_t f_cfg = TWAI_FILTER_CONFIG_ACCEPT_ALL();

  twai_driver_install(&g_cfg, &t_cfg, &f_cfg);

  twai_start();

}

void send_can(uint32_t id, const void* data) { // CAN送信

  twai_message_t msg = {.extd = 1, .identifier = id, .data_length_code = 8};

  if (data) memcpy(msg.data, data, 8);

  twai_transmit(&msg, 0);

}

void SparkMax(float setpoint) { // 復帰確認 & SPARK MAX送信 (20ms周期)

  unsigned long now = millis();

  if (now – lastSendTime < 20) return; // 20ms経過していなければ抜ける

  lastSendTime = now;

  twai_status_info_t s;

  twai_get_status_info(&s);

  if (s.state == TWAI_STATE_BUS_OFF) twai_initiate_recovery(), twai_start(); // Bus-Off自動復帰

  uint8_t hb[8] = {255, 255, 255, 255, 255, 255, 255, 255};

  send_can(0x02052C80, hb); // Heartbeat送信

  uint8_t ctrl[8] = {0};

  memcpy(ctrl, &setpoint, sizeof(float));

  send_can(0x02050C80 | (1 & 0x3F), ctrl); // Position_Set送信 (DeviceID: 1)

}

メインのコードは紛失したのでうろ覚えで書きました
関数の方は実際に大会で使っていた内容です。

定期的にCANでデータを送らないと動かない仕様で20msおきに送信するのが正解っぽいです
ハートビートとか言うらしい。かっこよ

↓マイコンから制御している様子です。

すこしクセの強いモーターですが、いざ扱えるようになると、ものすごく便利です。

他の制御方式も同じように実行できると思います。

動かない場合は以下を疑ってみてください
・制御方式の不一致
・終端抵抗(総当たりする覚悟で)
・ファームウェアのバージョン

購入

私はキャチロボの部品支給を活用して入手しました。

モーターは海外の物ですが、日本では代理店があるため簡単に購入できます。

NEO Brushless Motor V1.1 ¥8,550
NEO Brushless Motor V1.1 – Redigiform

SPARK MAX Motor Controller ¥16,200
SPARK MAX Motor Controller – Redigiform

こうみると、めっちゃ高いわけでもないですねー
3万くらいの感覚でいましたが2万ちょいで買えるじゃないですか

ロボマスの代替品としていかがでしょうか。

]]>
/%e9%ab%98%e7%b4%9a%e3%83%a2%e3%83%bc%e3%82%bf%e3%83%bc%e9%96%8b%e6%8b%93%e8%a8%98/feed/ 0
合宿中にロボコンの進捗あげてみた /%e5%90%88%e5%ae%bf%e4%b8%ad%e3%81%ab%e3%83%ad%e3%83%9c%e3%82%b3%e3%83%b3%e3%81%ae%e9%80%b2%e6%8d%97%e3%81%82%e3%81%92%e3%81%a6%e3%81%bf%e3%81%9f/ Tue, 09 Sep 2025 11:38:19 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=1467

おはようございます。

どうやら、K*RISEの合宿が1泊2日であるようです。

私も合宿をエンジョイする予定でしたが、大会2週間前なのに完成しないロボットのことで頭がいっぱいです。

仕方ありません。合宿を楽しみつつ進捗あげます。

1日目のスケジュールは以下のとおりです。

限られた時間でロボットを作って、かつ記事を書かなければなりません。

この時点でやや無茶な予感がしますが、やるかやらないかではなく「しなければならない」のです。

それでは早速、現状をお伝えします。

かっこよくないですか?

この見た目で現状1点もとれません。

このロボットに求められる仕様は、このようにお菓子を回収して横にあるシューティングエリアに置くというタスクをこなす事です。

いや、不安定ながら回収はできるんです。

取ったお菓子を横のシューティングエリアまで持っていけないため、得点できません。

設計当初はサブアームをこのように回り込ませてお菓子を受渡し、そのまま得点する予定でした。

しかし、このサブアームがお菓子を受取る姿勢、どう考えても綺麗に受け取れません。

問題点がいくつかあります。

  • 受取り皿の大きさが足りない
  • アプローチ姿勢が苦しい
  • Z軸の可動域不足
  • Y軸の自由度が被っており精度がでない

設計段階で気づけなかったことを悔やんでもしょうがないので解決策を考えます。

ええ。考えます。

まだ、これといった解決策が思いつきません。

めちゃ焦ってます。

とりあえず、Y軸の重複を無くすため直道機構を1つ消します。

消しました。(Z軸も延長しました)

※ここまでが昨日までの進捗です。

ロボットはシンプルであればあるほど良いとされています。

スカラアームを制御できるか怪しいですがやるしかないですね。


8:30~9:50

というわけで1日目の朝です。

集合前の時間は自由です。

作業します。

ここで問題発生。

コートの縁が本来50mmのところ45mmしかありません

なんで…

応急処置します。

切ります

貼ります

完成しました(影響するのは手前だけなので。)

次。

土台を20mm下げたので緊急停止ボタンが下側に飛び出しています。

あらかじめ印刷しておいたスペーサーを挟みます。

ついでにネジが干渉する部分を切り飛ばしたリングも取り付けます

良さそうです。

そうこうしているうちに、新たな問題を見つけてしまいました。

メインアームのZ軸がフィールド中央の屋根に干渉してます。

20mm切り飛ばせばいい話ですが、モーターの角度や、重力と釣り合わせるための定重バネが厄介です。

とは言っても、致命的なので手間をかけてでもすべき作業です。

今すぐ取り掛かりたいところですがタイムアップ。

合宿の集合時間です。


15:15~16:20

1時間でZ軸問題をどうにかします。

外しました。

大変でした。

切りました。

全てはこの1太刀のためです。

さて、最難関。

定荷重バネの取付けです。

引っ張りながらネジを締める…なんて曲芸をやってのける必要があります。

やってやりました

無事、屋根下を通過できるようになりました。

スレスレです(3mm)

とりあえず完了したのでメインアームからサブアームにお菓子を受渡す機構を考えます。(本題)

いろいろ考えましたが、機構の形が見えてきません。

ここら辺にサーボを配置すれば…等々考えていたら時間に。


20:45~22:00

こんな時間まで作業できるって合宿の醍醐味じゃないですか?

頑張ります。

必要な板を切り出します

完成図が自分の中で不鮮明なことが一番の気がかりです。

パーツを切り出します

タップ掘ります。

この作業、地味に時間使う上に失敗する(折れる)可能性があるので、あまり好きじゃないです。

途中まで組んでみました

嫌な予感がします

メンテナンス性が…

解決策はいくつかありますが、そんなことより機構として実現できるかどうかが重要です。

追加で必要な部品を探します。

ありませんでした。

追加パーツのデータを作ります。

モデリングしました

切削します。

ひとつ前に完成していた部品を処置します

処置しました。

綺麗なパーツに仕上がりました。

途中まで組み付けました。

なんかかっこいい

もう1つの部品も完了したようです。

組付け…

先端に取り付けるパーツのネジ頭が干渉します。

問題が把握できたことを収穫だと捉えて今日の活動は終了します。

おやすみなさい


おはようございます

2日目の朝です。

5時くらいに作業するか迷いましたが2度寝しました。

7:00~9:00

朝採れパーツを組込みます。

昨日の問題はスペーサーで板を浮かせることで解決しました。

追加の部品を生成します。

組付けます。

パスされる時はアーム中間関節が手前側に来ているのに、設置する時は奥側に来ています

これは制御、どうなるんだ…?

不穏な空気を感じます。

とりあえず、パス機構の試験作ができたことを喜びましょう。

実験します。

①各種類1つ計5つのお菓子を吸着します。

②中央に折りたたんで寄せます。

③全体を後ろ側に動かして、パス機構の真上にお菓子がくるようにします。

④パス機構の上にお菓子を落とします。

⑤パス機構を180°回転させます。

⑥慣性と遠心力で良い感じにサブアームにパスします(?)

⑦サブアームが陳列棚にお菓子を置きます。

⑧立てます。

途中、怪しい工程がありましたが、全体的な流れは悪くないと思います。

パス機構の配線をします。

コネクタを圧着します。

この作業、楽しいので暇な人はやってみてください。

結線完了しました。

次にサーボの設定をします。

原点を合わせたら、次はプログラミングです。

ここで時間。


13:30~14:50

8番サーボを追記します。

ライブラリに甘えたコードなので簡単です。

a〜jの値をloop内で更新することによって角度を変更します。

コントローラーのここを操作に割当てます。

角度はこれから詰めます。

動かしてみると角度が浅く、動きが想定と逆だと判明しました。

修正しました。

オーバーラン気味です。

修正します

2,3度修正した結果、最適な角度を見つけられました。

初期値も同様に調節します。

↓初期状態

↓右ボタン

↓左ボタン

よさそうです。

それでは、実験してみます。

掴んで寄せるタイミングでチューブが引っかかりますが見なかったことにします。

受渡してーーーー

いぃぃぃいいいや滞空姿勢が素晴らしく美しい!

実験は成功です。

この状態だと、ボーナス得点は無いものの得点としては確実に認められます。

サブアームの制御は間に合いませんでしたが、私はこの合宿を通じて、得点能力を持たないアルミの塊に命を吹き込みました。

まさに歴史的瞬間です。

間に合ってよかった…

この記事で皆さんに成功を報告できて嬉しいです!

今後はボーナス得点獲得のため、サブアームの制御を進めつつ、問題点を潰していきます。

ここまで読んでくださりありがとうございます。

またいつか。

]]>