イベント | K*RISE / 九産大の学生による大学魅力発信プロジェクト Fri, 25 Sep 2026 00:00: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 弱小校(?)が学ロボに出場した方法 /%e5%bc%b1%e5%b0%8f%e6%a0%a1%e3%81%8c%e5%ad%a6%e3%83%ad%e3%83%9c%e3%81%ab%e5%87%ba%e5%a0%b4%e3%81%97%e3%81%9f%e6%96%b9%e6%b3%95/ /%e5%bc%b1%e5%b0%8f%e6%a0%a1%e3%81%8c%e5%ad%a6%e3%83%ad%e3%83%9c%e3%81%ab%e5%87%ba%e5%a0%b4%e3%81%97%e3%81%9f%e6%96%b9%e6%b3%95/#respond Fri, 25 Sep 2026 00:00:00 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=4022

20年ぶりの挑戦で出場できた件について、よく聞かれるので、まとめ的な内容を書きます。

※私は20年前を知りません。

ロボット紹介は下記の記事よりご覧ください。

Q.なぜ出場できた?

A.わかりません

審査結果に対して理由が公開されないことから不明です。

言っていいのか分かりませんが一次審査直後から取材がありました。

「注目校」枠か「新参校」枠っぽさはありました。

一次審査時のR1
一次審査時のR2

実際、二次審査では撮影で通しの実施ができず、継ぎ接ぎ状態で提出しました。

Q.マネジメントはどのように?

A.人に期待しない

そもそもエントリー当初、一人で挑む予定でした。

しかし思いのほか手伝ってくれるメンバーが多かったため分担できました。

基本的には「仕事ふる」→「仮完成状態で納品してもらう」→「自分で最終調整」といった流れでした。

もちろん例外もあります。

仕事をふっても、してくれなかったり拒否されたり、逆に組込みまで仕上げてくれたり…

ただ、全てにおいて最終調整の責任を自分にすることで問題が発生してもカバーできました。

Q.ノウハウはどこから?

A.工業高校でのロボコン経験と4つのロボコン

高校ロボコンは、コロナ明けで、かつ先生が入れ替わった時期に始めました。

この時に、「試行錯誤とは何なのか」を学びました。

最終的に、とりあえずロボットを作れる程度の技術を持って高校を卒業できました。

大学(前半)では多くのロボコンに挑戦しました。

九州夏ロボコン、キャチロボ、トマトロボット、学ロボの4つです。

場数を踏むと、何が強いのか、どうやって実現するのか、といったノウハウが得られます。

たくさんの敗北と少しの勝利を経てノウハウを作りました。

Q.メンバー集めはどうやって?

A.入部ハードルを下げた

前提として、まず知ってもらわなければなりません。

サークル勧誘の片隅で勧誘してみたり、ポスター作ったり、各種SNSをしてみたりと、できること全てしました。

入学直後に作ったポスター

次に、興味を持ってくれた人をできる限り引き込みます。

定例会を設けず、部費徴収をせず、簡単に脱退できる旨を伝えます。

入部してくれる人がデメリットに感じそうな物を極限まで排除しました。

そして、とにかく制限を減らしました。

ゲーム禁止、飲食禁止など、他の場所に行く理由になりそうなルールを設けていません。

結果、加工機械を使っている中でサッカーが始まるというカオスも発生しました(さすがに注意しました)が、何とか集団として成り立っています。

アレコレしたら部員が50人を突破しました。

働きアリの法則的に考えると母数は多ければ多い方が良いですよね。

Q.活動時間はどれくらい?

A.使える時間全て使いました

だいたい活動場所には、危険な工作機械があるため教職員がいるときでないと作業できないという体制の団体が多いのではないでしょうか。

ロボット工房では良くも悪くもそのような規則はありません。

よって、土日祝日朝から晩、気が済むまで作業できます。(入試関連の日を除く)

基本的には授業の空きコマと放課後(21時前くらいまで)、さらに土日も活動時間に当てました。

もちろん強制はしなかったので私以外のメンバーが工房にいる時間は、体感で半分以下でした。

長期休暇もほとんど毎日学校に行く日々でしたが、年始年末は暖房が効かなくなるのでアルミを加工する手が震えて大変でした。そんな時期に加工が発生するのは段取りの問題なんですけどね

今振り返ると1日でも欠けたら、あのロボットはできてなかったです。

とまぁ、このような状況だったのでK*RISE(このサイトの運営団体)の定例会に一切参加できませんでした、ごめんなさい。
たぶん絶対これからも同じ状況なので、許されるならリモートワーク的な形でこれからも続けていけたらいいな…と。

Q.資金は?

A.環境に恵まれていました

もともとヒューマノイドをしていた団体なので、良いサーボモーターが沢山あります。

また、過去のヒューマノイドの実績から予算もついていました。

さらに研究室と併設されているため過去に研究で使用した物を譲っていただけます。

譲っていただいたDepthカメラ3つ

とは言いつつ、周辺のロボコン団体と比べると予算額は同等か、それ以下みたいです。

夏ロボの優勝賞品が無ければ今回は間違いなく詰んでました。

10万円分のモーター

自腹で購入した物品もいくつかあります。

まとめ

いかがでしたか?

全体的に士気の向上もみられるので今後に期待したいですね。

質問など、九産大ロボット工房のXかインスタでDMしていただけると回答できます。

文字ばかりの記事になってしまいましたが、ここまで読んでくださりありがとうございます。

それでは、またいつか。

]]>
/%e5%bc%b1%e5%b0%8f%e6%a0%a1%e3%81%8c%e5%ad%a6%e3%83%ad%e3%83%9c%e3%81%ab%e5%87%ba%e5%a0%b4%e3%81%97%e3%81%9f%e6%96%b9%e6%b3%95/feed/ 0
NHK学生ロボコン2026ロボット紹介 /nhk%e5%ad%a6%e7%94%9f%e3%83%ad%e3%83%9c%e3%82%b3%e3%83%b32026%e3%83%ad%e3%83%9c%e3%83%83%e3%83%88%e7%b4%b9%e4%bb%8b/ /nhk%e5%ad%a6%e7%94%9f%e3%83%ad%e3%83%9c%e3%82%b3%e3%83%b32026%e3%83%ad%e3%83%9c%e3%83%83%e3%83%88%e7%b4%b9%e4%bb%8b/#respond Fri, 28 Aug 2026 00:00:00 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=3968

大変長らくお待たせいたしました。

スマホ故障で情報社会から隔離されていました、、、
という言い訳が効かないほど日数が経ってしまいました、ぶちょーです。

今回はNHK学生ロボコン2026の紹介をします。

ルール

テーマは「カンフークエスト」

タスクは大きく3つです。

①武器を組立てる

  ロボット2台で協力して組み立てます
  許容誤差は1mm程度です

  ②ブック(箱)回収

  大きめの箱を回収します
  回収の可否が模様によって定められています

  ③ブック(箱)設置

  棚に箱を置きます。
  縦か斜めに3つ並べた時点で勝利が確定します
  相手の箱を①で組み立てた武器で落とせます

  詳しいルールはコチラからご覧ください。

戦績

予選一試合目:敗北
(九州産業大学vs豊橋技術科学)

予選二試合目:勝利
(九州産業大学vs大阪工業大学)

 →予選敗退

ライブ配信(YouTube)

R1機構

大会出場時のR1
一次審査の補足資料
二次審査の補足資料

ブック(箱)を置く動作と武器で突き落とす動作は同一の面でできた方が良いだろうという話になり、トンボ型の機体になりました。

ブックを1つしか回収できないのも、これの弊害です。

↑インホイール式独立ステアリング機構※私の設計ではありません
R2を持ち上げるときの荷重にメカナムやオムニは耐えられないかも、と考え独ステになりました。
ステアリングが遅すぎました。(サーボ)
タイヤのグリップはダイソーで買える「犬のおもちゃ」ですが、劣化すると割れが発生してしまいました。

↑ポール回収ハンド※私の設計ではありません
蝶番部でポールを押し当てて掴みます。


↑武器組立て機構
空気圧シリンダーで瞬間的に大きな力を与えることで許容誤差が大きくとれました。
後付けなのでサーボモーターで機構ごと避ける動作をしないとポール回収直後に干渉します。

↑ブック回収機構
サーボモーターでワイヤーを引っ張り保持します。
サーボのトルクリミッターが効いてしまったり電源供給が不足したりと、安定性に欠ける仕様でした。
こういう保持には空気圧シリンダーが向いていそうですね。
M2006で電流制御してもよかったのか?
グリップにはダイソーの軍手を使ってます。

↑Z軸昇降機構
下部にあるプーリーを巻き取ると動滑車を通じてワイヤーで全体が持ち上がります。
左右のバーでR2を持ち上げるためハイトルク仕様。
下降はワイヤーを緩めることで自重を活用して落下する仕組みです。このため定荷重バネで吊ることができませんでした。おとなしくタイミングベルトかチェーンを使った方がよさそうです。

↑コントローラー
スマホを搭載できるようにしていましたが使いませんでした。
1試合目で無線トラブルが発生したので来年はルーターを背負いたいところです。

R2機構

大会出場時のR2
一次審査の補足資料
二次審査の補足資料

段差の登り降りが履帯だと速いんじゃね?
という発想から、このような形になりました。

ぜんぜん速くなかったです。

ただ、R1に持ち上げてもらう都合上、軽い方が良いのは確かで、軽量化という第2の目標は達成されています。

R2単体の重量は10.8kg

横移動を捨てたのは致命的でした

↑ヘッド回収ハンド※私の設計ではありません。
ヘッドは奪い合いが発生するため、横移動のできない本機には2本のアームを設けており、すぐに2つ目を再試行することができます。
2試合目で2つのヘッドを回収してしまったのは、アーム根元のサーボが不調で、中途半端に掴んだヘッドがセンサーの判定に入らなかったためです。

↑ヘッド回収アーム
サーボで根本から動かす単純な機構ですが、武器組み立て時の衝撃を受けるため、角パイプの末端が接触するようになっています。
サーボ軸に大きな引っ張り荷重が加わることになりますが壊れませんでした。よかった。

↑ブック回収ハンド
R1とほぼ同じ設計です。
2関節のアームでアプローチします。

↑Depthカメラ
前方と左右に1つずつ、合計3つ搭載しています。
贅沢な構成ですね。

機体中央の謎空間には、お守りが取り付けられています。
ただをこねるR2
段差を登る時の成功率は80%くらいでした。
(本番会場では100%。段の角と地面のグリップが重要)

回路

ローム株式会社様、コアスタッフオンライン様、電子部品を提供いただいたにも関わらず、ロボットに組み込めず、大変申し訳ございません。

全て秋月電子やAmazonでポチッた既製品で構成しています。

(試作では提供いただいたチップLEDやチップ抵抗を使いました)

では、電源付近からご紹介します。

マキタの18vバッテリー
満充電で20vを超えるため24vとみなして運用しています。
マキタの10.8vバッテリー
満充電で12vを超えるため12vとみなして運用しています。
ヒューズ(120a)
12v、24v系統に1つずつ設けています
この前、短絡させてしまいましたが切れませんでした
選定ミスったみたいです
リレー
緊急停止ボタンのスイッチングで動作します。
各バッテリーに対して1つずつ設けています。

次に制御系です。

メインの制御はESP32を1台だけで運用しています。
ラズパイやM5stackはセンサー的な役割です。

近藤科学のサーボはICS変換基板を使わない方式です。
PWMピンが数珠つなぎになったイメージで非常に配線しやすかったです。
R1は配線距離が長くなり、動作不良が頻発してしまいました。
配線距離は規格の範囲内にすべきですねー

画像認識

3台のRealSense(深度カメラ)を使いました。考えられる中で最大級に豪華な構成なんじゃないですかね

Raspberry Pi 5 1台だけで処理しています。
カメラで前と左右をリアルタイム検出、判別をしています。
実はUSBの帯域が不足しており2回に1回ほど映像データの取得に失敗します。
しかたがないので取得に失敗したときには前回の映像を表示するようにしました。
フレームレートは8程度だと思います。

ソフト

基本的にはArduinoIDEで開発しています。
大したことはしていないので、とりあえず張り付けておきます。

R1のプログラム

2026_R1_test77.ino

/*—————————–

 R1制御 ESP32-WROOM              //v3.3.4

——————————–*/

#include “DJIMotorCtrlESP.hpp”   //v2.0.5

#include “HXC_TWAI.hpp”          //v1.0.5

#include <ESP32Servo.h>          //v3.0.9

#include <IcsBaseClass.h>        //v3

#include <IcsHardSerialClass.h>  //v3

#include <Wire.h>                //標準

#include <MPU6050_tockn.h>       //v1.5.2

#include <PS4Controller.h>       //1.1.0

// ===== MPU6050 角度計算タスク(Core 0で永続ループ)=====

MPU6050 mpuA(Wire), mpuB(Wire);

volatile float stableYaw = 0;  // マルチタスクで使う変数はvolatile

float prevYawA = 0, prevYawB = 0;

const float THRESHOLD_NOISE = 5.0;

TaskHandle_t IMUTaskHandle;  // タスクハンドル

// ===== 角度計算タスク(Core 0で永続ループ) =====

void imuUpdateTask(void *pvParameters) {

  while (true) {

    mpuA.update(), mpuB.update();

    float currentA = mpuA.getGyroAngleZ(), currentB = mpuB.getGyroAngleZ();  // 90度倒し

    float diffA = abs(currentA – prevYawA), diffB = abs(currentB – prevYawB);

    if (diffA > THRESHOLD_NOISE && diffB < THRESHOLD_NOISE) stableYaw += (currentB – prevYawB);  // 冗長化ロジック

    else if (diffB > THRESHOLD_NOISE && diffA < THRESHOLD_NOISE) stableYaw += (currentA – prevYawA);

    else stableYaw += ((currentA – prevYawA) + (currentB – prevYawB)) / 2.0;

    prevYawA = currentA, prevYawB = currentB;

    vTaskDelay(10 / portTICK_PERIOD_MS);  // 10ms間隔で更新

  }

}

Servo A1;                       //ノーマルサーボ宣言

Servo M5;                       //通信用PWM宣言

HXC_TWAI CAN_BUS(17, 16);       //CAN

M3508_P19 MOTOR1(&CAN_BUS, 1);  //ロボマス

M3508_P19 MOTOR2(&CAN_BUS, 2);

M3508_P19 MOTOR3(&CAN_BUS, 3);

M3508_P19 MOTOR4(&CAN_BUS, 4);

M3508_P19 MOTOR5(&CAN_BUS, 5);  //Z軸

M2006_P36 MOTOR6(&CAN_BUS, 6);  //Y軸

HardwareSerial SerialICS(1);    //近藤サーボ

const int ICS_PIN = 12;

IcsHardSerialClass krs(&Serial1, 23, 115200, 8);              // 7応答時間 timeout

const int A1Pin = 14;                                         //武器回収根本

const int M5Pin = 5;                                          //M5通信

const int MOSFET = 19;                                        //空気圧

const int startSW = 13;                                       //スタートボタン

const int dis = 35, BRdis = 27, BLdis = 26;                   //距離センサー(前方)(右後方)(左後方)

const int rLED = 33, gLED = 25, bLED = 32;                    //フルカラーLED

const int MOTOR_SIGN[4] = { -1, +1, -1, +1 };                 //モーター取り付け符号

double currentX = 0, currentY = 0, targetX = 0, targetY = 0;  //座標,目標

long lastEnc[4] = { 0, 0, 0, 0 };                             //エンコーダ

const double PULSE_TO_MM = 0.01;

const double SERVO_MIN_DEG = -137.0, SERVO_MAX_DEG = 43.0;  //サーボ可動域(実角度)

const int SERVO_MIN = 3500, SERVO_MAX = 11500;              //サーボ可動域(指令値)

double driveTheta = 0;                                      //状態保持

int hou = 0;

const int A1angle = 75;     //初期値

const int maxSpeed = 400;   //操縦時最高速

const int rev = 8192 * 19;  //M3508が1回転

const float ACCEL = 8.0;

long Z_HOME = 0, Z_UP = rev * 11.1, Z_Little = rev / 3;  // Z軸

bool zUpState = false;                                   // 今上がっているか

long motor5_target = 0;

long motor6_target = 0;                                                      // MOTOR6目標位置

bool clawOpen = 1, prevSquare = false, prevRight = false, prevLeft = false;  // 前回のボタン状態

int field = 0;                                                               //青コート1、赤コート2

int d;

int z = 3.25;                    //ポール回収y軸修正

bool isWeaponReleased = false;  // 武器を離した状態かどうかのフラグ

bool prevShareState = false;    // 前回のボタン状態(連打防止用)

bool lastUp = false, lastDown = false, lastRight = false, lastLeft = false;

const int SERVO5_CLOSE_VAL = 5300;  //  サーボ5のブック保持の値(値を小さくすると強く保持)———————————————– 元5500

const int SERVO5_OPEN_VAL = 8700;   // サーボ5のブック離す値

const int SERVO6_CLOSE_VAL = 7500;  //  サーボ6のポール固定する値(値を小さくすると強く保持)

const int SERVO6_OPEN_VAL = 8000;   // サーボ6のポール固定解除の値

const int SERVO7_CLOSE_VAL = 7500;  //  サーボ7のポール回収の値(値を小さくすると強く保持)

const int SERVO7_OPEN_VAL = 8100;   // サーボ7のポールを離す値

const int SERVO8_AVOID_VAL = 4600;  //  サーボ8のシリンダー避けるときの値(値を小さくすると押し付けを弱める)

const int SERVO8_SET_VAL = 7400;    // サーボ8のいシリンダーセットの値

void setup() {

  set();            //各種設定

  StartPosition();  //スタートボタン押されるまで待機

  weaponCatch();    //ポール回収

  PS4doujyou();     //槍組み立て(半自動)

  A1.write(52);     //干渉回避

}

void loop() {

  if (PS4.isConnected()) {

    ;                     //PS4コントローラー接続せよ

    PS4main();            //手動操作

  } else {                //接続切れたらライブラリ内のコードが作動する可能性

    MOTOR1.set_speed(0);  // モーター停止

    MOTOR2.set_speed(0);

    MOTOR3.set_speed(0);

    MOTOR4.set_speed(0);

    digitalWrite(2, millis() % 500 < 100);  // LED点滅

    digitalWrite(rLED, HIGH);

    digitalWrite(gLED, 0);

    digitalWrite(bLED, 0);

  }

  if (PS4.PSButton()) {  //操縦から再開

    StartPosition();

    A1.write(52);  //干渉回避

  }

}

set.ino

void set() {

  Serial.begin(9600);

  PS4.begin(“ec:c9:ff:e3:23:1e”);  //ps4コントローラーMACアドレス

  A1.attach(A1Pin);

  M5.attach(M5Pin);

  M5.write(5);

  pinMode(startSW, INPUT_PULLUP);

  pinMode(MOSFET, OUTPUT);

  pinMode(2, OUTPUT);

  pinMode(rLED, OUTPUT);

  pinMode(gLED, OUTPUT);

  pinMode(bLED, OUTPUT);

  pinMode(dis, INPUT);

  pinMode(BRdis, INPUT);

  pinMode(BLdis, INPUT);

  digitalWrite(rLED, LOW);

  digitalWrite(gLED, LOW);

  digitalWrite(bLED, LOW);

  Wire.begin(21, 22);  //ジャイロピン

  delay(250);          //これがないとジャイロが不安定になる?

  mpuA.begin(), mpuB.begin();

  Serial.println(“Fast Calibrating (Mode)…”);

  const int samples = 500;

  // 最頻値カウント用の配列(バケット)

  // 例:-250〜249(分解能0.1なら -25.0 〜 +24.9°/s)をカバー

  #define BUCKET_OFFSET 250

  #define BUCKET_SIZE 500

  int bucketAZ[BUCKET_SIZE] = { 0 };

  int bucketBZ[BUCKET_SIZE] = { 0 };

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

    digitalWrite(2, millis() % 250 < 50);

    digitalWrite(rLED, millis() % 250 < 50);

    mpuA.update(), mpuB.update();

    // 小数点第1位で丸めるために10倍し、四捨五入(intキャスト)

    int valAZ = (int)round(mpuA.getGyroZ() * 10.0) + BUCKET_OFFSET;

    int valBZ = (int)round(mpuB.getGyroZ() * 10.0) + BUCKET_OFFSET;

    // 配列の範囲内に収まるかチェックしてカウント

    if (valAZ >= 0 && valAZ < BUCKET_SIZE) bucketAZ[valAZ]++;

    if (valBZ >= 0 && valBZ < BUCKET_SIZE) bucketBZ[valBZ]++;

    delay(1);

  }

  // 最頻値(一番多くカウントされた値)を探す

  int maxCountA = 0, modeIdxA = BUCKET_OFFSET;

  int maxCountB = 0, modeIdxB = BUCKET_OFFSET;

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

    if (bucketAZ[i] > maxCountA) {

      maxCountA = bucketAZ[i];

      modeIdxA = i;

    }

    if (bucketBZ[i] > maxCountB) {

      maxCountB = bucketBZ[i];

      modeIdxB = i;

    }

  }

  // インデックスを実際のfloat値に戻す

  float modeAZ = (float)(modeIdxA – BUCKET_OFFSET) / 10.0;

  float modeBZ = (float)(modeIdxB – BUCKET_OFFSET) / 10.0;

  mpuA.setGyroOffsets(0, 0, modeAZ), mpuB.setGyroOffsets(0, 0, modeBZ);

  Serial.println(“Calibration Done.”);

  xTaskCreatePinnedToCore(imuUpdateTask, “IMUTask”, 4096, NULL, 1, &IMUTaskHandle, 0);

  CAN_BUS.setup();

  MOTOR1.set_speed_pid(1.0, 0.0, 0.1, 0.0, 10000);

  MOTOR2.set_speed_pid(1.0, 0.0, 0.1, 0.0, 10000);

  MOTOR3.set_speed_pid(1.0, 0.0, 0.1, 0.0, 10000);

  MOTOR4.set_speed_pid(1.0, 0.0, 0.1, 0.0, 10000);

  MOTOR5.set_location_pid(2.0, 0.05, 0.5, 0.0, 13000);

  MOTOR6.set_location_pid(0.8, 0.01, 0.1, 0.01, 13000);

  MOTOR1.setup();

  MOTOR2.setup();

  MOTOR3.setup();

  MOTOR4.setup();

  MOTOR5.setup();

  MOTOR6.setup();  //-7.6 伸ばす

  Z_HOME = MOTOR5.get_location();

  MOTOR6.set_location(MOTOR6.get_location() + 8000);  // y軸余裕を少し持つ

  SerialICS.begin(115200, SERIAL_8N1, -1, 12);

  krs.begin();

  digitalWrite(rLED, LOW);

  stableYaw = 0;

  delay(100);

}

PS4doujyou.ino

void PS4doujyou() {

  int stage1 = 320;  // 第一段階

  int stage2 = 370;  //第二段階

  int stageB = 495;

  if (field == 1 || field == 2) {

    int basespeed = 40;  //自動前進の速度

    int taegetYaw;       //自動補正目標角

    if (field == 1) {

      taegetYaw = -90;

    } else {

      taegetYaw = 90;

    }

    int def = 0, p = 10;  //角度補正 p値は補正強さ

    int Lspeed, Rspeed;   //角度補正基準値

    int count = 0, count2 = 0, count3 = 0, count4 = 0;

    if (!PS4.isConnected()) return;  //PS4コントローラー接続せよ

    while (1) {

      digitalWrite(2, millis() % 1500 < 100);                //一定周期での点灯

      analogWrite(rLED, (millis() % 1500 < 500) ? 255 : 0);  //オレンジ

      analogWrite(gLED, (millis() % 1500 < 500) ? 200 : 0);  //緑

      analogWrite(bLED, 0);//消灯

      krs.setPos(8, SERVO8_SET_VAL);  //シリンダーセット

      if (PS4.Square()) break;

      //if ((count = (analogRead(dis) > stageB ? count + 1 : 0)) >= 5) break;  //組み立て距離 475

      if ((count2 = (analogRead(dis) > stage1 ? count2 + 1 : 0)) >= 5) basespeed = 20;  //減速第一段階

      if ((count3 = (analogRead(dis) > stage2 ? count3 + 1 : 0)) >= 5) basespeed = 10;  //減速第二段階

      // — やり直し動作 —  

      if (PS4.Down()) {

        basespeed = 40;       //下がったので再度最高速に

        krs.setPos(1, 9590);  // 左前

        krs.setPos(2, 9590);  // 右前

        krs.setPos(3, 9590);  // 左後

        krs.setPos(4, 9590);  // 右後

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

          MOTOR1.set_speed(i);

          MOTOR2.set_speed(-i);

          MOTOR3.set_speed(i);

          MOTOR4.set_speed(-i);

          delay(1);

        }

        for (int i = 100; i > 0; i–) {

          MOTOR1.set_speed(i);

          MOTOR2.set_speed(-i);

          MOTOR3.set_speed(i);

          MOTOR4.set_speed(-i);

          delay(1);

        }

      }

      // — 縦合わせ手動操作 —

      int step_z = rev * 0.07;                                              // 1回の移動量(調整可)

      if (PS4.R1() && motor5_target < rev * 11.1) motor5_target += step_z;  // R1 → 減少

      else if (PS4.L1() && motor5_target > 0) motor5_target -= step_z;      // L1 → 増加

      MOTOR5.set_location(motor5_target);

      // — 横合わせ手動操作 —

      if (PS4.LStickX() > 20) d = map(PS4.LStickX(), 20, 128, 0, -1650);    // -1900

      else if (PS4.LStickX() < -20) d = map(PS4.LStickX(), -20, -128, 0, 1650); // 1900

      else d = 0;

      krs.setPos(1, 9590 + d);

      krs.setPos(2, 9590 + d);

      krs.setPos(3, 9590 + d);

      krs.setPos(4, 9590 + d);

      // — Yaw角補正動作 —

      def = (stableYaw – taegetYaw) * p;  //(現在角-目標値)×補正強さ

      Lspeed = basespeed + def;           //基準速度+補正値

      Rspeed = basespeed – def;

      MOTOR1.set_speed(-Lspeed);

      MOTOR2.set_speed(Rspeed);

      MOTOR3.set_speed(-Lspeed);

      MOTOR4.set_speed(Rspeed);

      delay(50);

    }

    digitalWrite(rLED, HIGH);  //紫

    digitalWrite(gLED, LOW);

    digitalWrite(bLED, HIGH);

    MOTOR1.set_speed(0);  //停止

    MOTOR2.set_speed(0);

    MOTOR3.set_speed(0);

    MOTOR4.set_speed(0);

    MOTOR5.set_location(rev * 0.23);  //上げる

    //krs.setPos(6, SERVO6_OPEN_VAL);   //弱める

    delay(100);

    digitalWrite(MOSFET, HIGH);       //組み立て

    krs.setPos(6, SERVO6_CLOSE_VAL);  //閉じる

    delay(250);

    digitalWrite(MOSFET, LOW);

    delay(250);

    //krs.setPos(6, SERVO6_OPEN_VAL);  //弱める

    /*delay(100);*/

    digitalWrite(MOSFET, HIGH);       //組み立て

    krs.setPos(6, SERVO6_CLOSE_VAL);  //閉じる

    delay(250);

    digitalWrite(MOSFET, LOW);

    delay(250);

    krs.setPos(8, SERVO8_AVOID_VAL);  //避ける

    MOTOR5.set_location(rev * 2.2);   //上げる

    delay(350);

    MOTOR1.set_speed(250);  //後進

    MOTOR2.set_speed(-250);

    MOTOR3.set_speed(250);

    MOTOR4.set_speed(-250);

    delay(300);

    MOTOR1.set_speed(0);  //停止

    MOTOR2.set_speed(0);

    MOTOR3.set_speed(0);

    MOTOR4.set_speed(0);

    MOTOR5.set_location(Z_HOME);

    delay(800);  //Z軸戻る時間

  }

}

PS4main.ino

//—–メイン操作関数—–
int sub, ave, mspeed;
bool right_old = false;
bool left_old = false;
void PS4main() {
krs.setPos(6, SERVO6_CLOSE_VAL); //閉じる
analogWrite(rLED, (millis() % 1500 < 500) ? 255 : 0); //黄色 analogWrite(gLED, (millis() % 1500 < 500) ? 255 : 0); analogWrite(bLED, 0); digitalWrite(2, millis() % 1500 < 100); krs.setPos(8, SERVO8_AVOID_VAL); //よける if (!PS4.isConnected()) return; //—–足回り—– int rx = PS4.RStickX(), ry = -PS4.RStickY(), lx = -PS4.LStickX(); if (abs(lx) > 20) rotateByStick(lx); // 左スティック → 旋回
else if (abs(ry) > 20 || abs(rx) > 20) driveByStick(-ry, -rx); // 右スティック → 移動
else if (PS4.L2Value() > 20) { //横半自動送り
mspeed = map(PS4.L2Value(), 20, 255, 10, 400);
krs.setPos(1, 5590);
krs.setPos(2, 5590);
krs.setPos(3, 5590);
krs.setPos(4, 5590);
MOTOR1.set_speed(mspeed);
MOTOR2.set_speed(-mspeed); //3500-11150
MOTOR3.set_speed(mspeed);
MOTOR4.set_speed(-mspeed);
} else if (PS4.R2Value() > 35) { //横半自動送り
mspeed = map(PS4.R2Value(), 35, 255, 10, 400);
krs.setPos(1, 5590);
krs.setPos(2, 5590);
krs.setPos(3, 5590);
krs.setPos(4, 5590);
MOTOR1.set_speed(-mspeed);
MOTOR2.set_speed(mspeed);
MOTOR3.set_speed(-mspeed);
MOTOR4.set_speed(mspeed);
} else {
MOTOR1.set_speed(0);
MOTOR2.set_speed(0);
MOTOR3.set_speed(0);
MOTOR4.set_speed(0);
}
// ===== 十字キー右 =====
bool right_now = PS4.Right();
if (right_now && !right_old) {
krs.setPos(7, SERVO7_OPEN_VAL); // ピッキングハンド開く
A1.write(A1angle); // アーム上げる
delay(500);
krs.setPos(7, SERVO7_CLOSE_VAL); // ピッキングハンド保持
delay(300);
}
right_old = right_now;
// ===== 十字キー左 =====
bool left_now = PS4.Left();
if (left_now && !left_old) {
krs.setPos(7, SERVO7_OPEN_VAL); // ピッキングハンド開く
delay(500);
A1.write(A1angle – 23); // アーム下げる
delay(300);
}
left_old = left_now;
//—–Z軸(モーター5)—–
if (PS4.R1()) MOTOR5.set_location(Z_UP);
else if (PS4.L1()) MOTOR5.set_location(Z_HOME);
else MOTOR5.set_location(MOTOR5.get_location());
//—–ボタン操作—–
if (PS4.Triangle()) getBox(400); // △ボタン 400mm
else if (PS4.Circle()) getBox(200); // 〇ボタン 200mm
else if (PS4.Cross()) getBox(0); // ✕ボタン 0mm
if (PS4.Square()) { // □ボタン ハンド
clawOpen = !clawOpen;
delay(300); // 連続切替防止
}
if (clawOpen == 1) krs.setPos(5, SERVO5_OPEN_VAL); //開く
else krs.setPos(5, SERVO5_CLOSE_VAL); //閉じる 元3800
//—–Y軸(モーター6)—–
int stepy = rev * 0.3; // 1回の移動量(調整可)
if (PS4.Up() && motor6_target > -rev * 7.6) motor6_target -= stepy; // → 減少
else if (PS4.Down() && motor6_target < 0) motor6_target += stepy; // L1 → 増加 MOTOR6.set_location(motor6_target); delay(10); if (PS4.Touchpad()) { //武器離す krs.setPos(7, SERVO7_OPEN_VAL); //ピッキングハンド開く A1.write(A1angle); //アーム上げる delay(500); krs.setPos(7, SERVO7_CLOSE_VAL); //ピッキングハンド保持 delay(300); krs.setPos(6, SERVO6_OPEN_VAL); //筒形ハンド開く delay(300); for (int i = A1angle; i <= A1angle + 70; i += 10) { A1.write(i); //アーム下げる delay(200); } krs.setPos(7, SERVO7_OPEN_VAL); //ピッキングハンド開く delay(500); krs.setPos(7, SERVO7_CLOSE_VAL); //ピッキングハンド保持 A1.write(A1angle); //アーム少し上げる delay(500); A1.write(A1angle – 23); //アーム上げる } // シェアボタンが「押された瞬間」だけ判定 if (PS4.Share() && !prevShareState) { if (!isWeaponReleased) { // — 1回目:武器を離す動作 — krs.setPos(7, SERVO7_OPEN_VAL); // ピッキングハンド開く A1.write(A1angle); // アーム上げる delay(500); krs.setPos(7, SERVO7_CLOSE_VAL); // ピッキングハンド保持 delay(300); krs.setPos(6, SERVO6_OPEN_VAL); // 筒形ハンド開く delay(300); A1.write(A1angle + 45); // アーム下げる delay(300); krs.setPos(6, SERVO6_OPEN_VAL); // 筒形ハンド開く delay(300); isWeaponReleased = true; // 状態を「離した」に更新 } else { // — 2回目:アームを戻して準備する動作 — krs.setPos(6, SERVO6_OPEN_VAL); // 筒形ハンド開く delay(300); A1.write(A1angle); // アーム上げる delay(2000); //バウンド収まり待ち krs.setPos(6, SERVO6_CLOSE_VAL); // 筒形ハンド閉じる delay(300); krs.setPos(7, SERVO7_OPEN_VAL); // ピッキングハンド開く delay(300); A1.write(A1angle – 23); // アーム上げる delay(300); // isWeaponReleased = false; // 状態を「戻した」にリセット } } prevShareState = PS4.Share(); // ボタン状態を保存 } //—–直進関数—– void driveByStick(int rx, int ry) { double theta = atan2(ry, rx) * 180.0 / PI; //方向計算 int hou = 0; if (theta < SERVO_MIN_DEG || theta > SERVO_MAX_DEG) theta += (theta > 0) ? -180.0 : 180.0, hou = 1;
int Kangle = map((int)theta, SERVO_MIN_DEG, SERVO_MAX_DEG, SERVO_MIN, SERVO_MAX); //サーボ角変換
Kangle = constrain(Kangle, SERVO_MIN, SERVO_MAX);
for (int id = 1; id <= 4; id++) krs.setPos(id, Kangle);
double power = sqrt(rx * rx + ry * ry); // 速度計算
double speed = map(power, 20, 128, 0, 500);
speed = constrain(speed, 0, maxSpeed);
int dir = (hou == 0) ? 1 : -1;
MOTOR1.set_speed(speed * dir * MOTOR_SIGN[0]);
MOTOR2.set_speed(speed * dir * MOTOR_SIGN[1]);
MOTOR3.set_speed(speed * dir * MOTOR_SIGN[2]);
MOTOR4.set_speed(speed * dir * MOTOR_SIGN[3]);
}
//—–旋回関数—–
void rotateByStick(int lx) { //旋回
krs.setPos(1, 9590 – 2000); // 左前 サーボをハの字にする
krs.setPos(2, 3500 + 20); // 右前
krs.setPos(3, 3500 + 20); // 左後
krs.setPos(4, 9590 – 2000); // 右後
int turnSpeed = map(abs(lx), 20, 128, 0, 400); //スティックから回転速度
if (lx < 0) turnSpeed = -turnSpeed;
MOTOR1.set_speed((-turnSpeed) * MOTOR_SIGN[0]);
MOTOR2.set_speed((-turnSpeed) * MOTOR_SIGN[1]);
MOTOR3.set_speed((turnSpeed)MOTOR_SIGN[2]); MOTOR4.set_speed((turnSpeed)MOTOR_SIGN[3]);
}

Select.io

int pickupPoint = 0;

void Select() {

  if (pickupPoint == 0) {             //初期設定(左から2番目)

    if (field == 1) pickupPoint = 2;  //青コート

    if (field == 2) pickupPoint = 3;  //赤コート

  }

  bool nowRight = PS4.Right();

  bool nowLeft = PS4.Left();

  // — 右移動 —

  if (nowRight && !lastRight) {

    if (pickupPoint % 4 != 0) pickupPoint++;  // 4の倍数でなければ右にいける

  }

  // — 左移動 —

  if (nowLeft && !lastLeft) {

    if (pickupPoint % 4 != 1) pickupPoint–;  // 4で割って1余る数でなければ左にいける

  }

  lastRight = nowRight;  //前回の状態を代入

  lastLeft = nowLeft;

  if (field == 1) M5.write((pickupPoint + 4) * 10);       //青コートPWM送信(5,6,7,8)

  else if (field == 2) M5.write((pickupPoint + 8) * 10);  //赤コートPWM送信(9,10,11,12)

  else {

    pickupPoint = 0;

    M5.write(4 * 10);  //無選択PWM送信(4)

  }

}

StartPosition.ino

void StartPosition() {

  while (digitalRead(startSW) == 1 && PS4.Square() == 0) {

    Select();

    krs.setPos(1, 9590 – 4000);

    krs.setPos(2, 9590 – 4000);

    krs.setPos(3, 9590 – 4000);

    krs.setPos(4, 9590 – 4000);

    krs.setPos(5, SERVO5_OPEN_VAL);  //開く

    krs.setPos(6, SERVO6_OPEN_VAL);  //開く

    krs.setPos(7, SERVO7_OPEN_VAL);  //開く

    krs.setPos(8, SERVO8_AVOID_VAL);  //よける

    A1.write(A1angle);

    digitalWrite(MOSFET, LOW);

    digitalWrite(2, LOW);

    Serial.printf(” ポール回収位置 = %d”, pickupPoint);

    Serial.printf(” 方向 = %.2f”, stableYaw);

    Serial.printf(” 前方 = %d”, analogRead(dis));

    Serial.printf(” 右後 = %d”, analogRead(BRdis));

    Serial.printf(” 左後 = %d\n”, analogRead(BLdis));

    digitalWrite(gLED, millis() % 1500 < 1000);

    if (PS4.Touchpad()) field = 0; //手動操作

    if (PS4.Share()) field = 1;  //青コート

    if (field == 1) digitalWrite(bLED, millis() % 1500 >= 1000);

    else digitalWrite(bLED, LOW);

    if (PS4.Options()) field = 2;  //赤コート

    if (field == 2) digitalWrite(rLED, millis() % 1500 >= 1000);

    else digitalWrite(rLED, LOW);

  }

  digitalWrite(2, HIGH);

}

getBox.ino

/* ============

箱回収

============ */

void getBox(int high) {

  digitalWrite(rLED, HIGH);  //紫

  digitalWrite(gLED, LOW);

  digitalWrite(bLED, HIGH);

  A1.write(A1angle – 23);          //アーム少し下げる

  krs.setPos(5, SERVO5_OPEN_VAL);  //開く

  switch (high) {

    case 0:

      MOTOR5.set_location(rev * 0);  //上げる

      delay(500);

      MOTOR6.set_location(rev * -6.4);  //伸ばす

      delay(500);

      MOTOR6.set_location_pid(0.8, 0.01, 0.1, 0.01, 5000);  //速度変換

      delay(10);

      MOTOR6.set_location(rev * -7.4);  //伸ばす

      delay(500);

      MOTOR6.set_location_pid(0.8, 0.01, 0.1, 0.01, 13000);  //速度変換

      delay(10);

      krs.setPos(5, SERVO5_CLOSE_VAL);  //つかむ

      delay(500);

      MOTOR5.set_location(rev * 9.90);  //+1上げる

      delay(500);

      break;

    case 200:

      MOTOR5.set_location(rev * 4.56);  //rev * 4.56

      delay(2000);

      MOTOR6.set_location(rev * -6.4);  //伸ばす

      delay(500);

      MOTOR6.set_location_pid(0.8, 0.01, 0.1, 0.01, 5000);  //速度変換

      delay(10);

      MOTOR6.set_location(rev * -7.4);  //伸ばす

      delay(500);

      MOTOR6.set_location_pid(0.8, 0.01, 0.1, 0.01, 13000);  //速度変換

      delay(10);

      krs.setPos(5, SERVO5_CLOSE_VAL);  //つかむ

      delay(500);

      MOTOR5.set_location(rev * 9.90);  //+1上げる

      delay(500);

      break;

    case 400:

      MOTOR5.set_location(rev * 8.80);  //rev * 8.80

      delay(2000);

      MOTOR6.set_location(rev * -6.4);  //伸ばす

      delay(500);

      MOTOR6.set_location_pid(0.8, 0.01, 0.1, 0.01, 5000);  //速度変換

      delay(10);

      MOTOR6.set_location(rev * -7.4);  //伸ばす

      delay(500);

      MOTOR6.set_location_pid(0.8, 0.01, 0.1, 0.01, 13000);  //速度変換

      delay(10);

      krs.setPos(5, SERVO5_CLOSE_VAL);  //つかむ

      delay(500);

      MOTOR5.set_location(rev * 9.90);  //+1上げる

      delay(500);

      break;

  }

  MOTOR6.set_location(0);  //縮む

  delay(500);

  zUpState = true;

  digitalWrite(rLED, LOW);

  digitalWrite(gLED, LOW);

  digitalWrite(bLED, LOW);

  clawOpen = false;

}

moveTo.ino

/* =====================================================

オドメトリ(進行方向でXY積分)

===================================================== */

void updateOdometry() {

  long enc[4] = {

    MOTOR1.get_location(),

    MOTOR2.get_location(),

    MOTOR3.get_location(),

    MOTOR4.get_location()

  };

  double sum = 0;

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

    long diff = enc[i] – lastEnc[i];

    lastEnc[i] = enc[i];

    sum += diff * MOTOR_SIGN[i];

  }

  double d = (sum / 4.0) * PULSE_TO_MM;  // ここで物理単位に変換している場合、distも物理単位

  double rad = driveTheta * PI / 180.0;

  currentX += d * cos(rad);

  currentY += d * sin(rad);

}

/* =====================================================

目標座標へ移動(ステアリング待機ロジック実装版)

サーボ速度: 125RPM (750 deg/sec) を基準に計算

===================================================== */

void moveTo(double x, double y) {

  x *= 51.5, y *= 51.5;  // 座標系のスケーリング

  targetX = x, targetY = y;

  static double currentServoTheta = 0;  // 最後に「待機」を判断した基準角度

  static double v = 0;

  static unsigned long lastMicros = 0;

  static unsigned long steeringWaitUntil = 0;

  bool arrived = false;

  // — パラメータ設定 —

  const double V_MAX = 500.0;

  const double A_MAX = 250.0;

  const double STOP_DIST = 100.0;

  const double STOP_V = 20.0;

  const double SERVO_DEG_PER_SEC = 750.0;

  const unsigned long MARGIN_MS = 25;

  const double THETA_THRESHOLD = 5.0;  // 何度以上の変化で「一旦止まって待つ」か

  v = 0;

  lastMicros = micros();

  while (1) {

    /* ===== 1. 時間更新とオドメトリ ===== */

    unsigned long now = micros();

    double dt = (now – lastMicros) / 1000000.0;

    lastMicros = now;

    if (dt <= 0) dt = 0.001;

    updateOdometry();

    /* ===== 2. 目標計算 ===== */

    double dx = targetX – currentX;

    double dy = targetY – currentY;

    double dist = sqrt(dx * dx + dy * dy);

    // 停止判定

    if (dist < STOP_DIST && v < STOP_V) arrived = true;

    if (arrived) {

      MOTOR1.set_speed(0);

      MOTOR2.set_speed(0);

      MOTOR3.set_speed(0);

      MOTOR4.set_speed(0);

      currentX = targetX;

      currentY = targetY;

      break;

    }

    /* ===== 3. ステアリング角度決定 (スイッチバック対応) ===== */

    double theta = atan2(dy, dx) * 180.0 / PI;

    int nextHou = 0;

    if (theta < SERVO_MIN_DEG || theta > SERVO_MAX_DEG) {

      theta += (theta > 0) ? -180.0 : 180.0;

      nextHou = 1;

    }

    /* ===== 4. サーボ指令(常に送信)と待機判定 ===== */

    // A. サーボ指令の作成と送信(毎ループ実行)

    int Kangle = map((int)theta, SERVO_MIN_DEG, SERVO_MAX_DEG, SERVO_MIN, SERVO_MAX);

    Kangle = constrain(Kangle, SERVO_MIN, SERVO_MAX);

    for (int id = 1; id <= 4; id++) {

      krs.setPos(id, Kangle);  // 指令は常に送る

    }

    // B. 大幅な角度変化があった場合のみ、駆動ロック(待機)を設定

    // これを毎回やると steeringWaitUntil が更新され続けて走行不能になる

    double angleDiff = fabs(theta – currentServoTheta);

    if (angleDiff > THETA_THRESHOLD || nextHou != hou) {

      unsigned long travelTimeMs = (unsigned long)((angleDiff / SERVO_DEG_PER_SEC) * 1000.0);

      steeringWaitUntil = millis() + travelTimeMs + MARGIN_MS;

      currentServoTheta = theta;  // 基準角度を更新

      hou = nextHou;

      v = 0;  // 急旋回時は速度をリセット

    }

    driveTheta = theta;  // オドメトリ用の角度計算用

    /* ===== 5. 駆動ロック処理 ===== */

    if (millis() < steeringWaitUntil) {

      MOTOR1.set_speed(0);

      MOTOR2.set_speed(0);

      MOTOR3.set_speed(0);

      MOTOR4.set_speed(0);

      delay(1);

      continue;  // ロック中は以下の加速・出力処理をスキップ

    }

    /* ===== 6. 速度制御ロジック(走行中) ===== */

    double v_limit_dist = sqrt(0.5 * A_MAX * (dist / (STOP_DIST / 10.0)));

    double v_target = min(V_MAX, v_limit_dist);

    double dv = v_target – v;

    double max_dv = A_MAX * dt;

    if (dv > max_dv) dv = max_dv;

    if (dv < -max_dv) dv = -max_dv;

    v += dv;

    /* ===== 7. モータ出力 ===== */

    int dir = (hou == 0) ? 1 : -1;

    int speed = constrain((int)v, 0, (int)V_MAX);

    MOTOR1.set_speed(speed * dir * MOTOR_SIGN[0]);

    MOTOR2.set_speed(speed * dir * MOTOR_SIGN[1]);

    MOTOR3.set_speed(speed * dir * MOTOR_SIGN[2]);

    MOTOR4.set_speed(speed * dir * MOTOR_SIGN[3]);

    delay(1);

  }

}

turnTo.ino

void turnTo(double targetAngle) {

  // — 1. サーボを旋回用の「ハの字」に変形(指令1回だと不安定) —

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

    krs.setPos(1, 9590 – 2000);  // 左前

    krs.setPos(2, 3500 + 20);    // 右前

    krs.setPos(3, 3500 + 20);    // 左後

    krs.setPos(4, 9590 – 2000);  // 右後

  }

  // — 2. 制御パラメータ —

  const double Kp = 5.0;            // 比例ゲイン(ズレに対する強さ)

  const double TURN_V_MAX = 200.0;  // 最大速度制限

  const double TURN_V_MIN = 15.0;   // 最低速度(摩擦で止まらないための底上げ)

  const double TOLERANCE = 0.5;     // 許容誤差(度)

  int stableCount = 0;              // 安定判定用カウンタ

  // — 3. 旋回ループ —

  while (true) {

    double currentAngle = stableYaw;            // Core 0 の imuUpdateTask で更新されている最新の角度を取得

    double error = targetAngle – currentAngle;  // 最短経路での誤差計算(180度以上回らないように補正)

    while (error > 180.0) error -= 360.0;

    while (error < -180.0) error += 360.0;

    if (fabs(error) < TOLERANCE) {  // 終了判定:誤差が TOLERANCE 以内ならカウント

      stableCount++;                // 10ms周期で10回連続(=0.1秒間)安定したらループ脱出

      if (stableCount >= 10) break;

    } else {

      stableCount = 0;  // 範囲外に出たらカウンタリセット

    }

    double turnSpeed = error * Kp;                              // P制御による速度計算

    turnSpeed = constrain(turnSpeed, -TURN_V_MAX, TURN_V_MAX);  // 速度を MAX_RPM (100) 以内に制限

    // 振動防止と死に体対策

    if (fabs(error) < TOLERANCE) turnSpeed = 0;  // 範囲内なら出力を切る(ハンチング防止)

    else {                                       // 範囲外かつ計算結果が小さすぎる場合、最低速度を保証して動かす

      if (fabs(turnSpeed) < TURN_V_MIN) {

        turnSpeed = (error > 0) ? TURN_V_MIN : -TURN_V_MIN;

      }

    }

    // — 4. モーター出力 —

    // MOTOR_SIGN を掛けて取り付け向きを補正し、全輪で旋回トルクを生む

    // 旋回時は「前進/後退」の向きではなく「回転」の向きを揃える

    int out = (int)turnSpeed;

    MOTOR1.set_speed(-out * MOTOR_SIGN[0]);

    MOTOR2.set_speed(-out * MOTOR_SIGN[1]);

    MOTOR3.set_speed(out * MOTOR_SIGN[2]);

    MOTOR4.set_speed(out * MOTOR_SIGN[3]);

    delay(10);  // ループ周期(100Hz)

  }

  MOTOR1.set_speed(0);  // — 5. 停止処理 —

  MOTOR2.set_speed(0);

  MOTOR3.set_speed(0);

  MOTOR4.set_speed(0);

  driveTheta = stableYaw;  // オドメトリ用の保持角度を更新して終了

}

weaponCatch.ino

// ===== ポール回収 =====

void weaponCatch() {

  int xb = 1500;  //後方判定r 1460 l 1630 元 1490

  double dx, dy;  //移動座標

  //stableYaw = 0;     //角度0に再定義

  int w = 0;

  while (w == 0) {

    if (xSemaphoreTake(i2cMutex, portMAX_DELAY) == pdTRUE) {

      w = 1;

      // ======================================

      stableYaw = 0;

      prevYawA = 0;

      prevYawB = 0;

      mpuA.update();

      mpuB.update();

      prevYawA = mpuA.getGyroAngleZ();

      prevYawB = mpuB.getGyroAngleZ();

      // =======================================

      xSemaphoreGive(i2cMutex);  // 終わったら安全に解放

    }

  }

  if (field == 2) {  //赤コート——————————————————————————————

    digitalWrite(rLED, HIGH);

    digitalWrite(gLED, LOW);

    digitalWrite(bLED, HIGH);

    krs.setPos(6, SERVO6_OPEN_VAL);  //開く

    krs.setPos(7, SERVO7_OPEN_VAL);  //開く

    if (pickupPoint == 4) {          //R1側から1番目

      dx = 60;

      dy = 186 + z;

    } else if (pickupPoint == 3) {  //R1側から2番目OK

      dx = 60;

      dy = 206.5 + z;

    } else if (pickupPoint == 2) {  //R1側から3番目

      dx = 60;

      dy = 227.5 + z;

    } else if (pickupPoint == 1) {  //R1側から4番目

      dx = 60;

      dy = 248.5 + z;

    }

    moveTo(dx, dy);  //回収地点へ

    delay(100);

    turnTo(0);                                                    //角度ズレを補正

    for (int i = 0; i < 10; i++) krs.setPos(7, SERVO7_OPEN_VAL);  //開く

    A1.write(A1angle + 75);                                       //75(初期値)

    while (1) {                                                   //後進(センサー使用)

      dx -= 5;

      if (analogRead(BRdis) > xb && pickupPoint != 4) break;  //右センサー(一番近いポールじゃないとき)//値不安定

      if (analogRead(BLdis) > xb && pickupPoint != 1) break;  //左センサー(一番遠いポールじゃないとき)

      krs.setPos(7, SERVO7_OPEN_VAL);                         //開く

      if (PS4.LStickX() > 20) d = map(PS4.LStickX(), 20, 128, 1, -5);

      else if (PS4.LStickX() < -20) d = map(PS4.LStickX(), -20, -128, 1, 5);

      else d = 0;

      dy += d;

      moveTo(dx, dy);

    }

    for (int i = 0; i < 100; i++) krs.setPos(7, SERVO7_CLOSE_VAL);  //ピッキングハンド保持 delay(5)

    A1.write(A1angle);                                              //アーム上げる

    moveTo(dx + 23, 198);                                           //前

    delay(300);

    krs.setPos(6, SERVO6_CLOSE_VAL);  //筒形ハンド保持

    turnTo(88);                       //R2の方を向く

    krs.setPos(6, SERVO6_CLOSE_VAL);  //筒形ハンド保持

    krs.setPos(7, SERVO7_OPEN_VAL);   //ピッキングハンド開く

    delay(800);

    A1.write(A1angle – 23);  //アーム少し下げる

    delay(250);

    krs.setPos(8, SERVO8_SET_VAL);  //シリンダーセット

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

    digitalWrite(rLED, HIGH);

    digitalWrite(gLED, LOW);

    digitalWrite(bLED, HIGH);

    krs.setPos(6, SERVO6_OPEN_VAL);  //開く

    krs.setPos(7, SERVO7_OPEN_VAL);  //開く

    if (pickupPoint == 1) {          //R1側から1番目

      dx = 65;                       //

      dy = 188 + z;                  //

    } else if (pickupPoint == 2) {   //R1側から2番目OK

      dx = 65;                       //

      dy = 209 + z;                  //

    } else if (pickupPoint == 3) {   //R1側から3番目

      dx = 70;                       //

      dy = 230.5 + z;                //

    } else if (pickupPoint == 4) {   //R1側から4番目

      dx = 80;                       //

      dy = 249.5 + z;                //

    }

    moveTo(dx, -dy);  //回収地点へ

    delay(100);

    turnTo(0);                                                    //角度ズレを補正

    for (int i = 0; i < 10; i++) krs.setPos(7, SERVO7_OPEN_VAL);  //開く

    A1.write(A1angle + 75);                                       //75(初期値)

    while (1) {                                                   //後進(センサー使用)

      dx -= 5;

      if (analogRead(BRdis) > xb && pickupPoint != 4) break;  //右センサー(一番遠いポールじゃないとき)

      if (analogRead(BLdis) > xb && pickupPoint != 1) break;  //左センサー(一番近いポールじゃないとき)

      krs.setPos(7, SERVO7_OPEN_VAL);                         //開く(閉じる7300)

      moveTo(dx, -dy);

    }

    for (int i = 0; i < 100; i++) krs.setPos(7, SERVO7_CLOSE_VAL);  //ピッキングハンド保持 delay(5)

    A1.write(A1angle);                                              //アーム上げる

    moveTo(dx + 23, -198);                                          //前

    delay(300);

    krs.setPos(6, SERVO6_CLOSE_VAL);  //筒形ハンド保持

    turnTo(-90);                      //R2の方を向く

    krs.setPos(6, SERVO6_CLOSE_VAL);  //筒形ハンド保持

    krs.setPos(7, SERVO7_OPEN_VAL);   //ピッキングハンド開く

    delay(800);

    krs.setPos(7, SERVO7_OPEN_VAL);  //ピッキングハンド開く

    A1.write(A1angle – 23);          //アーム少し下げる

    delay(250);

    krs.setPos(8, SERVO8_SET_VAL);  //シリンダーセット

  }

}

R2のプログラム

2026_R2_test88

/*————————————————-

NHK Robocon 2026 R2

ESPwroom v3.3.4

・経路に応じてスタートボタンを押すと実行

・積荷センサーを覆いながらスタートすると武器回収なし

・アリーナ侵入後、リセットしないことでリトライ対応

————————————————-*/

#include “DJIMotorCtrlESP.hpp”   //ロボマス(v2.0.5)

#include “HXC_TWAI.hpp”          //CAN通信(v1.0.5)

#include <ESP32Servo.h>          //ノーマルサーボ(v3.0.9)

#include <IcsBaseClass.h>        //近藤科学サーボ(v3)

#include <IcsHardSerialClass.h>  //近藤科学サーボ(v3)

#include <Wire.h>                //ジャイロセンサー(標準)

#include <MPU6050_tockn.h>       //ジャイロセンサー(v1.5.2)

// ===== URM V5.0 PWM =====

#define URTRIG_F 18  //超音波出力ピン(共通)

#define URECHO_F 36  //超音波前方読み取りピン

#define URTRIG_B 18  //超音波出力ピン(共通)

#define URECHO_B 34  //超音波後方読み取りピン

// ===== ロボマス CAN =====

HXC_TWAI CAN_BUS(/*TX=*/17, /*RX=*/16);

M3508_P19 MOTOR1(&CAN_BUS, 1);  //速度制御(左履帯)

M3508_P19 MOTOR2(&CAN_BUS, 2);  //速度制御(右履帯)

M2006_P36 MOTOR3(&CAN_BUS, 3);  //速度制御(後方履帯)

// ===== MPU6050 冗長化設定 =====

MPU6050 mpuA(Wire);

volatile float stableYaw = 0;  // マルチタスクで使う変数はvolatile

float prevYawA = 0;

const float THRESHOLD_NOISE = 5.0;

TaskHandle_t IMUTaskHandle;  // タスクハンドル

// ===== 角度計算タスク(Core 0で永続ループ) =====

void imuUpdateTask(void *pvParameters) {

  while (true) {

    mpuA.update();                              // センサーの値を更新

    float currentA = mpuA.getGyroAngleX();      // 現在の角速度(または角度)を取得

    stableYaw += (currentA – prevYawA) * 0.5f;  // 前回の値との差分を計算して統合変数に加算

    prevYawA = currentA;                        // 次回計算用に現在の値を保存

    vTaskDelay(10 / portTICK_PERIOD_MS);        // 10ms間隔で更新

  }

}

// ===== 近藤科学サーボ UART =====

const int ICS_PIN = 12;

HardwareSerial SerialICS(2);

IcsHardSerialClass krs(&SerialICS, 23, 115200, 1);  //23ピンは後からSWピンとして上書き

// ===== GPIOピン =====

Servo A1, A2, FR1, BR2, FL3, BL4;                                                                //サーボ宣言

const int A1Pin = 14, A2Pin = 27, FRPin = 32, BRPin = 33, FLPin = 25, BLPin = 26;                //サーボピン

const int dis_PIN_R = 39, dis_PIN_L = 15, IR_PIN_R_Arm = 35, IR_PIN_L_Arm = 4, IR_PIN_Box = 19;  //センサー

const int LstartSW = 13, CstartSW = 0, RstartSW = 23;                                            //スイッチ

const int inputPin = 5;                                                                          //ラズパイ

const int FL_start = 146, FR_start = 35, BL_start = 105, BR_start = 62;                          //上昇機構サーボ初期値

const int A1_start = 100, A2_start = 75;                                                         //アームサーボ初期値

//梅花林エリア系

int results[7];   //受信データ代入配列

int masu = 0;     //現在地

int have = 0;     //持ってるブックの個数

int field = 1;    //0:通信不可,1:赤コート,2:青コート

int restart = 0;  //リスタート(1の時リスタート状態)

// ===== URM V5.0 読取関数 =====

unsigned int getDistanceCM(int trigPin, int echoPin) {

  digitalWrite(trigPin, LOW);

  delayMicroseconds(10);

  digitalWrite(trigPin, HIGH);

  unsigned long lowTime = pulseIn(echoPin, LOW, 50000);

  if (lowTime == 0 || lowTime >= 50000) return 999;

  return lowTime / 50;

}

void setup() {

  set();

  StartPosition();  //while文が中にある

  /*if (masu == 0) getBox_flat();       //Lボタン

  if (masu == 1) getOot();  //Cボタン

  if (masu == 2) getBox_down();               //Rボタン*/

  weapon_catch();  //道場

  baikarinn();     //梅花林

}

void loop() {

  arina();  //アリーナ

}

set.ino

/*———

初期設定

———–*/

void set() {

  Serial.begin(115200);

  Wire.begin();

  delay(250);  //これがないとジャイロが不安定になる?

  pinMode(2, OUTPUT);

  digitalWrite(2, HIGH);

  pinMode(inputPin, INPUT);

  mpuA.begin();

  mpuA.calcGyroOffsets();

  digitalWrite(2, LOW);

  Serial.println(“Calibration Done.”);

  xTaskCreatePinnedToCore(imuUpdateTask, “IMUTask”, 4096, NULL, 1, &IMUTaskHandle, 0);  //キャリブレーション直後に計算タスクを開始

  analogReadResolution(12);

  analogSetAttenuation(ADC_11db);

  CAN_BUS.setup();

  MOTOR1.set_speed_pid(1.0, 0.0, 0.1, 0.0, 10000);

  MOTOR2.set_speed_pid(1.0, 0.0, 0.1, 0.0, 10000);

  MOTOR1.setup();

  MOTOR2.setup();

  MOTOR3.setup();

  A1.attach(A1Pin);

  A2.attach(A2Pin);

  FR1.attach(FRPin);

  BR2.attach(BRPin);

  FL3.attach(FLPin);

  BL4.attach(BLPin);

  SerialICS.begin(115200, SERIAL_8N1, 12, 12);

  krs.begin();

  delay(100);

  Serial1.begin(115200, SERIAL_8N1, 5, -1);

  pinMode(dis_PIN_R, INPUT);  //下距離センサー

  pinMode(dis_PIN_L, INPUT);  //左距離センサー

  pinMode(URTRIG_F, OUTPUT);  //前方距離センサー

  digitalWrite(URTRIG_F, HIGH);

  pinMode(URECHO_F, INPUT);

  pinMode(URTRIG_B, OUTPUT);  //後方距離センサー

  digitalWrite(URTRIG_B, HIGH);

  pinMode(URECHO_B, INPUT);

  pinMode(IR_PIN_R_Arm, INPUT);     //右アームセンサー

  pinMode(IR_PIN_L_Arm, INPUT);     //左アームセンサー

  pinMode(LstartSW, INPUT_PULLUP);  //スタートボタン

  pinMode(CstartSW, INPUT_PULLUP);

  pinMode(RstartSW, INPUT_PULLUP);

}

StartPosition.ino

/*———————-

スタート前の状態&デバック

————————*/

void StartPosition() {  //初期姿勢

  while (1) {

    if (digitalRead(LstartSW) == 0) {  //左

      if (digitalRead(IR_PIN_Box) == 0) restart = 1;//積荷センサーでリスタート判定

      masu = 0;

      break;

    } else if (digitalRead(CstartSW) == 0) {  //中央

      if (digitalRead(IR_PIN_Box) == 0) restart = 1;//積荷センサーでリスタート判定

      masu = 1;

      break;

    } else if (digitalRead(RstartSW) == 0) {  //右

      if (digitalRead(IR_PIN_Box) == 0) restart = 1;//積荷センサーでリスタート判定

      masu = 2;

      break;

    }

    readUARTData();

    if (results[0] != 0) field = results[0];  //コート選択

    FL3.write(FL_start + 10);

    FR1.write(FR_start – 10);

    BL4.write(BL_start – 35);

    BR2.write(BR_start + 35);

    A1.write(A1_start);

    A2.write(A2_start);

    krs.setPos(1, 6000);

    digitalWrite(2, LOW);

    Serial.print(” Yaw = “);

    Serial.print(stableYaw);

    Serial.print(” 前超音波 = “);

    Serial.print(getDistanceCM(URTRIG_F, URECHO_F));

    Serial.print(” 後超音波 = “);

    Serial.print(getDistanceCM(URTRIG_B, URECHO_B));

    Serial.print(” 下赤外線 = “);

    Serial.print(analogRead(dis_PIN_R));

    Serial.print(” 左赤外線 = “);

    Serial.print(analogRead(dis_PIN_L));

    Serial.print(” 左ハンド = “);

    Serial.print(digitalRead(IR_PIN_L_Arm));

    Serial.print(” 右ハンド = “);

    Serial.print(digitalRead(IR_PIN_R_Arm));

    Serial.print(” 積荷 = “);

    Serial.print(digitalRead(IR_PIN_Box));

    Serial.print(” have = “);

    Serial.print(have);

    Serial.println();

    delay(50);  //早すぎるとバッファが飽和してフリーズする

  }

}

moveTo.ino

/*———

移動(台形速度制御)

———–*/

void moveTo(float targetDistMM) {

  // 台形速度制御の設定

  const float MAX_RPM = 350.0, MIN_RPM = 20.0;  // 速度(rpm)

  const float ACCEL_DIST = 400.0;               // 加速に要する距離(mm)

  FL3.write(FL_start + 10);

  FR1.write(FR_start – 10);

  BL4.write(BL_start – 35);  //後輪接地

  BR2.write(BR_start + 35);

  float startLoc1 = MOTOR1.get_location();

  float startLoc2 = MOTOR2.get_location();

  float currentDistMM = 0;

  float direction = (targetDistMM >= 0) ? 1.0 : -1.0;

  float totalDistAbs = abs(targetDistMM);

  const float countsPerMM = (8192.0 * 19.0) / (100.0 * 3.14159265);  //1mmあたりの回転

  while (abs(currentDistMM) < totalDistAbs) {

    float loc1 = MOTOR1.get_location() – startLoc1;  // 現在の走行距離を計算

    float loc2 = MOTOR2.get_location() – startLoc2;

    currentDistMM = ((loc1 + (-loc2)) / 2.0) / countsPerMM;

    float currentDistAbs = abs(currentDistMM);

    float distLeft = totalDistAbs – currentDistAbs;

    float currentTargetRPM = MAX_RPM;                                                                                   // 台形速度制御の計算

    if (currentDistAbs < ACCEL_DIST) currentTargetRPM = MIN_RPM + (MAX_RPM – MIN_RPM) * (currentDistAbs / ACCEL_DIST);  // 加速区間

    if (distLeft < (ACCEL_DIST * 1.5f)) {                                                                               // 減速区間(加速の1.5倍の距離で減速開始)

      float decelRPM = MIN_RPM + (MAX_RPM – MIN_RPM) * (distLeft / (ACCEL_DIST * 1.5f));

      if (decelRPM < currentTargetRPM) currentTargetRPM = decelRPM;

    }

    currentTargetRPM = constrain(currentTargetRPM, MIN_RPM, MAX_RPM);

    float speed = currentTargetRPM * direction;  // モーター出力(補正なし、左右均等)

    MOTOR1.set_speed(speed);

    MOTOR2.set_speed(-speed);  // 逆相なのでマイナス

    MOTOR3.set_speed(-speed);

    delay(10);

  }

  MOTOR1.stop(false);

  MOTOR2.stop(false);

  MOTOR3.stop(false);

}

/*————————————————————

移動(箱を追いかける)//繰り返しの実行で有効。終了後、停止操作いる。

————————————————————-*/

void moveBox() {

  BL4.write(BL_start);  //後輪上げる

  BR2.write(BR_start);

  MOTOR3.set_speed(0);                            //後輪停止

  readUARTData();                                 //受信データ読む

  if (results[5] <= -35 && results[5] >= -180) {  // 【左に補正】

    MOTOR1.set_speed(60);                         //減速

    MOTOR2.set_speed(-80);

  } else if (results[5] >= 35 && results[5] <= 180) {  // 【右にに補正】

    MOTOR1.set_speed(80);

    MOTOR2.set_speed(-60);  //減速

  } else {                  //±40以内

    MOTOR1.set_speed(80);

    MOTOR2.set_speed(-80);

  }

  delay(100);

}

turnTo.ino

/*—————————–

turnTo(絶対角,後方アームの挙動);

——————————-*/

void turnTo(float targetAbsoluteAngle, int flag) {

  BL4.write(BL_start);

  BR2.write(BR_start);

  float MAX_RPM = 350.0, MIN_RPM = 20.0;

  float turnKp = 1.0;

  float turnKd = 0.5;  // ★Dゲイン(ブレーキの強さ)を追加

  float deadBand = 1.0;

  int stableCount = 0;

  float goalYaw = targetAbsoluteAngle;

  static float lastYaw = 0.0;  // 前回ループ時の角度を保存する変数

  lastYaw = stableYaw;         // 初回ループ時のみ現在の角度で初期化

  //足出さないときのパラメーター

  if (flag == 0) {

    MAX_RPM = 100.0;  // ★D制御を入れるので、最高速度を少し上げても大丈夫になります

    MIN_RPM = 15.0;

    turnKp = 1.7;   // ★遠くからでもしっかり加速させるためにPを上げる

    turnKd = 20.0;  // ★【要微調整】スピードが速いほど強烈に逆噴射をかける(2.0〜6.0で調整)

    deadBand = 1.0;

  }

  while (true) {

    float currentYaw = stableYaw;  // ループ先頭の角度(裏で同期されている前提)

    float error = goalYaw – currentYaw;

    // 1. 終了判定

    if (abs(error) < deadBand) stableCount++;

    else stableCount = 0;

    if (stableCount > 5) break;

    // 2. 角速度(10msあたりの角度変化)を計算

    // 右回りを正、左回りを負とすると、勢いよく回っているほどこの値が大きくなる

    float omega = currentYaw – lastYaw;

    lastYaw = currentYaw;  // 次回のために保存

    // 3. 出力計算(P出力 – D出力)

    // 目標へ向かう力(error * turnKp) から、現在の勢いを殺す力(omega * turnKd) を引き算する

    float speed = (error * turnKp) – (omega * turnKd);

    speed = constrain(speed, -MAX_RPM, MAX_RPM);

    // 4. 速度の下限・不感帯処理

    if (abs(error) < deadBand) {

      MOTOR1.stop(false);

      MOTOR2.stop(false);

      continue;

    } else {

      // 遠いときはしっかり回し、目標付近でD制御による「逆噴射」が計算された場合は

      // MIN_RPMによる上書きを無視して、そのまま逆噴射(負の出力など)を許容する

      if (abs(speed) < MIN_RPM && (error * speed > 0)) {

        // errorとspeedが同符号(=まだ順方向に進もうとしている)の時だけ最低速度保証

        speed = (speed > 0) ? MIN_RPM : -MIN_RPM;

      }

    }

    // アーム制御

    if (abs(targetAbsoluteAngle – currentYaw) <= 3.8 && flag == 1) {

      BL4.write(BL_start – 35);

      BR2.write(BR_start + 35);

    } else if (flag == 0) {

      BL4.write(BL_start);

      BR2.write(BR_start);

    }

    MOTOR1.set_speed(-speed);

    MOTOR2.set_speed(-speed);

    MOTOR3.stop(false);

    delay(10);

  }

  MOTOR1.stop(false);

  MOTOR2.stop(false);

  MOTOR3.stop(false);

}

weapon_catch.ino

/——— 道場 ———–/
void weapon_catch() {
stableYaw = 0;
const int open = 6750; //ハンド開く
const int close = 4750; //ハンド閉じる
const int waterlevel = 4840; //台に沿わせる
const int armlittleup_L = 5070; //アーム少し上4950
const int armlittleup_R = 5000; //アーム少し上4950
const int armup = 7500; //アーム上
const int armdoun = 4800; //アーム下
int trial = 1; //試行回数
digitalWrite(2, HIGH);
if (restart == 0) { //リスタートじゃないとき
switch (trial) {
case 1: //—–1回目:左アーム試行—–
krs.setPos(5, armlittleup_L); //左アーム前
krs.setPos(4, armup); //右アーム上
krs.setPos(2, open); //ハンド開く
krs.setPos(3, close); //右閉じる
moveTo(970); //前進
stableYaw = 0;
krs.setPos(5, waterlevel); //到着後台に沿わせる
delay(300);
krs.setPos(2, close); //左ハンド閉じる
delay(350);
krs.setPos(5, armup); //真上
delay(350);
if (digitalRead(IR_PIN_L_Arm) == LOW && field == 1) { // 左センサー反応あり(赤)
moveTo(-1400); //後進 ———–下すべて
krs.setPos(4, armdoun); //下げる
turnTo(90, 1); //回転
moveTo(-400); //後進
turnTo(180, 1); //回転
break;
} else if (digitalRead(IR_PIN_L_Arm) == LOW && field == 2) { // 左センサー反応あり(青)
moveTo(-1600); //後進
krs.setPos(4, armdoun); //下げる
turnTo(-90, 1); //回転
moveTo(-550); //後進
turnTo(-180, 1); //回転
break;
} else trial++; //試行回数加算
case 2: //—–2回目:右アーム試行—–
krs.setPos(5, armup); //真上
moveTo(-100); //後進
krs.setPos(3, open);
krs.setPos(4, armlittleup_R); //アーム前
moveTo(120); //前進
stableYaw = 0;
krs.setPos(4, waterlevel); //到着後台に沿わせる
delay(250);
krs.setPos(3, close); //右ハンド閉じる
delay(350);
krs.setPos(4, armup); //アーム上
delay(350);
if (digitalRead(IR_PIN_R_Arm) == LOW && field == 1) { // 右センサー反応あり(赤)
moveTo(-1400); //後進
krs.setPos(5, armdoun); //下げる
turnTo(90, 1); //回転
moveTo(-500); //400+250(左右差)
turnTo(180, 1); //回転
break;
} else if (digitalRead(IR_PIN_R_Arm) == LOW && field == 2) { // 右センサー反応あり(青)
moveTo(-1600); //後進
krs.setPos(5, armdoun); //下げる
turnTo(-90, 1); //回転
moveTo(-300); //400+250(左右差)
turnTo(-180, 1); //回転
break;
} else trial++; //試行回数加算
case 3: //—–3回目:移動後、左アーム試行—–
moveTo(-150); //後進
if (field == 1) turnTo(90, 1); //赤
else turnTo(-90, 1); //青
moveTo(-320); //後進
turnTo(0, 1);
delay(250);
krs.setPos(2, open); //ハンド開く
delay(300);
krs.setPos(5, armlittleup_L); //左アーム前
krs.setPos(4, 7490); //右アーム上
krs.setPos(3, close); //右閉じる
moveTo(280); //前進(ちょっと多く)
stableYaw = 0;
krs.setPos(5, waterlevel); //到着後台に沿わせる
delay(250);
krs.setPos(2, close); //左ハンド閉じる
delay(350);
krs.setPos(5, armup); //真上
delay(350);
if (digitalRead(IR_PIN_L_Arm) == LOW && field == 1) { // 左センサー反応あり(赤)
moveTo(-1400); //後進
krs.setPos(4, armdoun); //下げる
turnTo(90, 1); //回転
moveTo(-50); //400-320(横にシフトした量)-30(微調整?)
turnTo(180, 1); //回転
break;
} else if (digitalRead(IR_PIN_L_Arm) == LOW && field == 2) { // 左センサー反応あり(青)
moveTo(-1600); //後進
krs.setPos(4, armdoun); //下げる
turnTo(-90, 1); //回転
moveTo(-200); //400-320(横にシフトした量)-30(微調整?)
turnTo(-180, 1); //回転
break;
} else trial++; //試行回数加算
case 4: //—–4回目:移動後、右アーム試行—–
krs.setPos(5, armup); //真上
moveTo(-320); //後進
krs.setPos(3, open);
krs.setPos(4, armlittleup_R); //アーム前
moveTo(280); //前進
stableYaw = 0;
krs.setPos(4, waterlevel); //到着後台に沿わせる
delay(250);
krs.setPos(3, close); //右ハンド閉じる
delay(350);
krs.setPos(4, 7490); //アーム上
delay(350);
if (digitalRead(IR_PIN_R_Arm) == LOW && field == 1) { // 右センサー反応あり(赤)
moveTo(-1400); //後進
krs.setPos(5, armdoun); //下げる
turnTo(-90, 1); //回転
moveTo(-200); //400+250-320(横にシフトした量)-30(微調整?)
turnTo(-180, 1); //回転
break;
} else if (digitalRead(IR_PIN_R_Arm) == LOW && field == 2) { // 右センサー反応あり(青)
moveTo(-1600); //後進
krs.setPos(5, armdoun); //下げる
turnTo(90, 1); //回転
moveTo(-50); //400+250-320(横にシフトした量)-30(微調整?)
turnTo(180, 1); //回転
break;
} else trial++; //試行回数加算
case 5: //—–5回目:移動後、左アーム試行—–
moveTo(-150); //後進
if (field == 1) turnTo(-90, 1); //赤
else turnTo(90, 1); //青
moveTo(450); //前進
turnTo(0, 1);
delay(250);
krs.setPos(2, open); //ハンド開く
//delay(250);
krs.setPos(5, armlittleup_L); //左アーム前
krs.setPos(4, armup); //右アーム上
krs.setPos(3, close); //右閉じる
moveTo(280); //前進(ちょっと多く)
stableYaw = 0;
krs.setPos(5, waterlevel); //到着後台に沿わせる
delay(250);
krs.setPos(2, close); //左ハンド閉じる
delay(350);
krs.setPos(5, armup); //真上
delay(350);
if (digitalRead(IR_PIN_L_Arm) == LOW && field == 1) { // 左センサー反応あり(赤)
moveTo(-1400); //後進
krs.setPos(4, armdoun); //下げる
turnTo(-90, 1); //回転
moveTo(-340); //400-320-320(横にシフトした量)
turnTo(-180, 1); //回転
break;
} else if (digitalRead(IR_PIN_L_Arm) == LOW && field == 2) { // 左センサー反応あり(青)
moveTo(-1600); //後進
krs.setPos(4, armdoun); //下げる
turnTo(90, 1); //回転
moveTo(-500); //400-320-320(横にシフトした量)
turnTo(180, 1); //回転
break;
} else trial++; //試行回数加算
case 6: //—–6回目:移動後、右アーム試行—–
krs.setPos(5, armup); //真上
moveTo(-100); //後進
krs.setPos(3, open);
krs.setPos(4, armlittleup_R); //アーム前
moveTo(160); //前進
stableYaw = 0;
krs.setPos(4, waterlevel); //到着後台に沿わせる
delay(250);
krs.setPos(3, close); //右ハンド閉じる
delay(350);
krs.setPos(4, armup); //アーム上
delay(350);
if (digitalRead(IR_PIN_R_Arm) == LOW && field == 1) { // 右センサー反応あり(赤)
moveTo(-1400); //後進
krs.setPos(5, armdoun); //下げる
turnTo(-90, 1); //回転
moveTo(-500); //400+250-320-320(横にシフトした量)
turnTo(-180, 1); //回転
break;
} else if (digitalRead(IR_PIN_R_Arm) == LOW && field == 2) { // 右センサー反応あり(青)
moveTo(-1600); //後進
krs.setPos(5, armdoun); //下げる
turnTo(90, 1); //回転
moveTo(-340); //400+250-320-320(横にシフトした量)
turnTo(180, 1); //回転
break;
} else { //所持失敗
krs.setPos(3, open); //ハンド開く
moveTo(-1600); //後進
krs.setPos(3, close); //ハンド閉じる
krs.setPos(4, 3500); //下げる
krs.setPos(5, 3500); //下げる
if (field == 1) {
turnTo(-90, 1); //回転
moveTo(-520);
turnTo(-180, 1); //回転
} else {
turnTo(90, 1); //回転
moveTo(-520);
turnTo(180, 1); //回転
}
break;
}
}
BL4.write(BL_start – 35); //後輪接地
BR2.write(BR_start + 35);
delay(600);
float axA = mpuA.getAccX(), ayA = mpuA.getAccY(), azA = mpuA.getAccZ(), refA = sqrt(axA * axA + ayA * ayA + azA * azA);
float threshold = 1.17; // 反応する加速度の大きさ
while (1) { // 振動発生まで待機
mpuA.update();
float cAxA = mpuA.getAccX(), cAyA = mpuA.getAccY(), cAzA = mpuA.getAccZ(), curA = sqrt(cAxA * cAxA + cAyA * cAyA + cAzA * cAzA);
if (abs(curA – refA) > threshold) break;
}
delay(650);
krs.setPos(2, open); //ハンド開く
krs.setPos(3, open);
delay(2500);
krs.setPos(2, close); //ハンド閉じる
krs.setPos(3, close);
krs.setPos(4, 3500); //下げる
krs.setPos(5, 3500); //下げる
digitalWrite(2, LOW);
moveTo(-900); //後進
} else { //リスタート時————————————————————
if (field == 1) { //赤
turnTo(90, 1);
moveTo(-350);
turnTo(179, 1);
} else { //青
turnTo(-90, 1);
moveTo(-350);
turnTo(-179, 1);
}
}
BL4.write(BL_start – 25); //後輪下げる(接地せず)
BR2.write(BR_start + 25);
delay(200);
for (int i = 0; i < 80; i++) { //加速
MOTOR1.set_speed(-i); //少し下がって押し付ける
MOTOR2.set_speed(+i);
MOTOR3.set_speed(0);
delay(5);
}
MOTOR1.set_speed(-80); //少し下がって押し付ける
MOTOR2.set_speed(+80);
MOTOR3.set_speed(0);
delay(1500);
MOTOR1.set_speed(0); //リセット
MOTOR2.set_speed(0);
MOTOR3.set_speed(0);
delay(500);
stableYaw = 0;
//赤
if (field == 1) {
if (masu == 2) moveTo(3600); //Rボタン
else if (masu == 0) moveTo(1080); //Lボタン
}
//青
else {
if (masu == 2) moveTo(1080); //Rボタン -200 + 1100
else if (masu == 0) moveTo(3600); //Lボタン
}
//共通
if (masu == 1) moveTo(2200); //Cボタン
stableYaw = 0;
if (field == 1) turnTo(90, 1); //赤
else turnTo(-89, 1); //青
delay(200);
moveTo(200);
unsigned int distance; //前方距離
int stopcount = 0; //止まった回数
while (true) {
readUARTData();
if (results[4] == 1 && stopcount == 0) { //前方Fakeのとき
stopcount++;
MOTOR1.set_speed(0);
MOTOR2.set_speed(0);
MOTOR3.set_speed(0);
delay(10000); //R1の速度に依存
moveTo(1200); //少し進む
}
distance = getDistanceCM(URTRIG_F, URECHO_F);
if (distance <= 50) break; //近づいた
moveTo(80); //箱を追いかける
}
krs.setPos(1, 6000); //getBox前準備
MOTOR1.set_speed(0);
MOTOR2.set_speed(0);
MOTOR3.set_speed(0);
}

baikarinn.ino

/*———

梅花林エリア

———–*/

int LRC[3][6] = {  //段差配列(赤基準)

  { 0, 200, 400, 200, 0, 0 },

  { 0, 0, 200, 400, 200, 0 },

  { 0, 200, 0, 200, 0, 0 }

};

void baikarinn() {

  if (field == 2) {  //青コート(配列を入れ替える)

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

      int tmp = LRC[0][i];    // 1つ目の行のi番目をキープ

      LRC[0][i] = LRC[2][i];  // 1つ目の行に3つ目の行の値を上書き

      LRC[2][i] = tmp;        // 3つ目の行にキープしていた値を入れる

    }

  }

  for (int i = 0; i < 5; i++) {  //5回実行

    delay(300);

    readUARTData();  //画像認識データ更新(念のため2回)

    readUARTData();

    //【特例対応】

    if (masu == 1 && i == 0) {  //中央列、初めの段

      if (analogRead(dis_PIN_L) > 1400) {

        stableYaw = 0;

        getBox_flat();  //ブックある

      } else {          //ブックない

        moveTo(-100);

        i++;

        readUARTData();  //画像認識データ更新(念のため2回)

        readUARTData();

      }

    }

    //【前方ブックあり】

    if (results[3] != 2) {

      stableYaw = 0;

      if (have == 2) getOot();                                          //2つ持ってる

      if (LRC[masu][i + 1] – LRC[masu][i] == 200) getBox_up();          //前方上

      else if (LRC[masu][i + 1] – LRC[masu][i] == -200) getBox_down();  //前方下

      else getBox_flat();                                               //前方段差なし

    }

    //【左ブックあり】(Realブックあり && 保持1以下 && 前奥反応なし && 左レーンじゃない)

    if (results[1] == 0 && have != 2 && results[4] == 2 && masu != 0) {

      moveTo(400);

      turnTo(-25, 1);

      moveTo(-350);

      turnTo(90, 1);  //左向く

      moveTo(50);

      stableYaw = 0;                                                        //補正のためリセット

      if (LRC[masu – 1][i] – LRC[masu][i] == 200) getBox_up();              //自身の左が上方

      else if (LRC[masu – 1][i] – LRC[masu][i] == -200) { getBox_down(); }  //自身の左が下方

      moveTo(400);

      turnTo(25, 1);

      moveTo(-350);

      turnTo(-90, 1);  //前に向きなおす

    }

    //【右ブックあり】(Realブックあり && 保持1以下 && 前奥反応なし && 右レーンじゃない)

    if (results[2] == 0 && have != 2 && results[4] == 2 && masu != 2) {

      moveTo(400);

      turnTo(25, 1);

      moveTo(-350);

      turnTo(-90, 1);  //右向く

      moveTo(50);

      stableYaw = 0;                                                        //補正のためリセット

      if (LRC[masu + 1][i] – LRC[masu][i] == 200) getBox_up();              //自身の右が上方

      else if (LRC[masu + 1][i] – LRC[masu][i] == -200) { getBox_down(); }  //自身の右が下方

      moveTo(400);

      turnTo(-25, 1);

      moveTo(-350);

      turnTo(90, 1);  //前に向きなおす

    }

    //【次のマスへ】

    if ((LRC[masu][i + 1] – LRC[masu][i]) == 0) {

      moveTo(1200);  //段差なし

      stableYaw = 0;

    } else if ((LRC[masu][i + 1] – LRC[masu][i]) == 200) up();   //上り

    else if ((LRC[masu][i + 1] – LRC[masu][i]) == -200) down();  //下り

    delay(250);

  }

  if (field == 1) {  //赤コート

    turnTo(-90, 1);

    if (masu == 2) moveTo(800);        //R

    else if (masu == 1) moveTo(2200);  //C

    else if (masu == 0) moveTo(3500);  //L

    turnTo(0, 1);

    moveTo(2000);  //アリーナに進入

    turnTo(90, 1);

    moveTo(2000);

  } else {  //青コート

    turnTo(90, 1);

    if (masu == 0) moveTo(800);        //L

    else if (masu == 1) moveTo(2200);  //C

    else if (masu == 2) moveTo(3500);  //R

    turnTo(0, 1);

    moveTo(2000);  //アリーナに進入

    turnTo(-90, 1);

    moveTo(3000);

  }

}

up.ino

/*———

段差登る

———–*/

void up() {

  // ===== 初期サーボ動作 =====

  digitalWrite(2, HIGH);

  krs.setPos(5, 4895);  //ヘッド回収機構の干渉防止

  krs.setPos(4, 4765);

  BL4.write(BL_start – 35);  //後輪接地

  BR2.write(BR_start + 35);

  delay(250);

  // ===== 1. 前方の段差に接近する動作 =====

  while (true) {

    unsigned int distance = getDistanceCM(URTRIG_F, URECHO_F);  //前方は条件満たしてる?

    if (distance <= 14) break;                                  //条件を満たした回数でbreak

    MOTOR1.set_speed(100);

    MOTOR2.set_speed(-100);

    MOTOR3.set_speed(-100);

    delay(10);

  }

  // ===== 2. 段差への乗り上げ開始(サーボ駆動) =====

  MOTOR1.set_speed(80);

  MOTOR2.set_speed(-80);

  MOTOR3.set_speed(-180);

  FL3.write(FL_start – 51);  //先に前アーム

  FR1.write(FR_start + 51);

  delay(100);//150

  BL4.write(BL_start – 78);

  BR2.write(BR_start + 78);

  delay(250);

  MOTOR1.set_speed(100);

  MOTOR2.set_speed(-100);

  MOTOR3.set_speed(-100);

  delay(550);

  // ===== 3. 後方壁検知で登りきりを確認 =====

  int n = 0;

  while (true) {

    unsigned int backDistance = getDistanceCM(URTRIG_B, URECHO_B);

    if (backDistance <= 12) n++;  //後方は条件満たしてる?

    if (n > 2) break;             //条件を満たした回数でbreak

    MOTOR1.set_speed(80);

    MOTOR2.set_speed(-80);

    MOTOR3.set_speed(-80);

    delay(30);

  }

  MOTOR1.set_speed(80);

  MOTOR2.set_speed(-80);

  MOTOR3.set_speed(-80);

  delay(250);

  MOTOR1.stop(false);

  MOTOR2.stop(false);

  MOTOR3.stop(false);

  FL3.write(FL_start);  //元の角度へ

  FR1.write(FR_start);

  BL4.write(BL_start);

  BR2.write(BR_start);

  delay(500);

  moveTo(350);  //要検討

  digitalWrite(2, LOW);

  stableYaw = 0;

}  // ここでup関数が終了

down.ino

/*———

段差降りる

———–*/

void down() {

  // ===== 初期サーボ動作 =====

  digitalWrite(2, HIGH);

  krs.setPos(5, 4895);  //ヘッド回収機構の干渉防止

  krs.setPos(4, 4765);

  delay(100);

  FL3.write(FL_start – 51);  //95

  FR1.write(FR_start + 51);  //86

  delay(500);

  // ===== 床検知の動作 =====

  int n = 0;

  while (true) {

    unsigned int distance = getDistanceCM(URTRIG_F, URECHO_F);

    if (distance > 6) n++;  //前方は条件満たしてる?

    if (n > 3) break;       //条件を満たした回数でbreak

    MOTOR1.set_speed(80);

    MOTOR2.set_speed(-80);

    MOTOR3.set_speed(-80);

    delay(50);

  }

  // ===== 減速中の動作 =====

  FL3.write(FL_start – 111);  //35

  FR1.write(FR_start + 111);  //146

  BL4.write(BL_start – 35);

  BR2.write(BR_start + 35);

  delay(500);

  // ===== 前方壁検知まで走行 =====

  int m = 0;

  while (true) {

    unsigned int floorDistanceF = getDistanceCM(URTRIG_F, URECHO_F);

    if (floorDistanceF >= 45) m++;  //前方は条件満たしてる?

    unsigned int floorDistanceB = getDistanceCM(URTRIG_B, URECHO_B);

    if (floorDistanceB >= 7) m++;  //後方は条件満たしてる?

    if (m > 3) break;              //条件を満たした回数でbreak

    MOTOR1.set_speed(80);

    MOTOR2.set_speed(-80);

    MOTOR3.set_speed(-80);

    delay(25);

  }

  // ===== 前方床検知後、サーボの角度を徐々に変更 =====

  // 開始角度(今の姿勢)

  int FL_now = 35;

  int FR_now = 146;

  int BL_now = BL_start – 35;

  int BR_now = BR_start + 35;

  // 目標角度(次の姿勢)

  int FL_target = 95;

  int FR_target = 86;

  int BL_target = BL_start;

  int BR_target = BR_start;

  int steps = 60;

  for (int i = 0; i <= steps; i += 7) {

    float t = (float)i / steps;

    FL3.write(FL_now + (FL_target – FL_now) * t);

    FR1.write(FR_now + (FR_target – FR_now) * t);

    BL4.write(BL_now + (BL_target – BL_now) * t);

    BR2.write(BR_now + (BR_target – BR_now) * t);

    MOTOR1.set_speed(50);

    MOTOR2.set_speed(-50);

    MOTOR3.set_speed(-50);

    delay(50);

  }

  // ===== 最終停止処理 =====

  MOTOR1.set_speed(80);  //少し進む

  MOTOR2.set_speed(-80);

  MOTOR3.set_speed(-80);

  delay(200);

  BL4.write(BL_start – 25);  //後輪下げる(接地せず)

  BR2.write(BR_start + 25);

  delay(200);

  MOTOR1.set_speed(-80);  //少し下がって押し付ける

  MOTOR2.set_speed(80);

  MOTOR3.stop(false);

  delay(750);

  moveTo(150);

  digitalWrite(2, LOW);

  stableYaw = 0;  //押し付けたので角度リセット

  delay(300);

}

getBox.ino

/—————————————— ブック回収 2つ目のブックを落とす : getOot(); 同じ段から回収(0m) : getBox_flat(); 高い段から回収(200mm) : getBox_up(); 低い段から回収(-200mm) : getBox_down(); ——————————————/
int grip = 4500; //箱掴む
int lowgrip = 5000; //箱掴む(少し弱く)
int nongrip = 8700; //ハンド広げる
// ===== 2つ目のブックを落とす =====
void getOot() {
digitalWrite(2, HIGH);
have = 1; //2つ目落とすと必ず1
krs.setPos(1, nongrip);
delay(500);
for (int i = A1_start + 5; i >= A1_start – 70; i -= 10) A1.write(i); // 105 → 30
krs.setPos(1, grip);
delay(300);
for (int i = A2_start – 10; i >= A2_start – 40; i -= 5) A2.write(i); // 叩き落とす
krs.setPos(1, nongrip);
delay(300);
for (int i = A2_start – 40; i <= A2_start; i += 5) A2.write(i); // 40 → 75 for (int i = A1_start – 70; i <= A1_start; i += 5) A1.write(i); // 30 → 100 delay(300); digitalWrite(2, LOW); } // ===== 自分の前方同じ段から回収(0m) ==== void getBox_flat() { have = 1; //※平面上の回収は1つ目以外ありえない digitalWrite(2, HIGH); krs.setPos(1, nongrip); readUARTData(); if (abs(results[5]) > 15) { //絶対値15以上のとき発動
turnTo(map(results[5], -170, 170, 60, -60), 1);
moveTo(150);
turnTo(0, 1);
} else moveTo(150);
for (int i = A1_start; i >= A1_start – 60; i -= 10) A1.write(i); // 100 → 40
for (int i = A2_start; i <= A2_start + 90; i += 10) A2.write(i); // 75 → 165 moveTo(250); krs.setPos(1, grip); //ボックス保持中 delay(300); for (int i = A1_start – 60; i <= A1_start – 25; i += 5) A1.write(i); // 40 → 75 for (int i = A2_start + 90; i >= A2_start – 15; i -= 5) A2.write(i); // 165 → 60
for (int i = A2_start – 15; i <= A2_start; i += 4) A2.write(i); // 60 → 75 for (int i = A1_start – 25; i <= A1_start; i += 4) A1.write(i); // 75 → 100 A2.write(80); delay(450); krs.setPos(1, nongrip); A2.write(75); delay(200); digitalWrite(2, LOW); } // ===== 自分より高い段から回収(200mm) ===== void getBox_up() { digitalWrite(2, HIGH); krs.setPos(1, nongrip); readUARTData(); if (abs(results[5]) > 15) { //絶対値20以上のとき発動
turnTo(map(results[5], -170, 170, 60, -60), 0);
moveTo(150);
turnTo(0, 0);
} else moveTo(150);
moveTo(250);
moveTo(-400);
for (int i = A2_start; i <= A2_start + 60; i += 10) A2.write(i); // 75 → 135 for (int i = A1_start; i >= A1_start – 100; i -= 8) A1.write(i); // 100 → 0
moveTo(250);
for (int i = 0; i < 5; i++) moveTo(20); krs.setPos(1, grip); //ボックス保持中 delay(450); if (digitalRead(IR_PIN_Box) == LOW) { //1ボックス設置済み have = 2; for (int i = A1_start – 100; i <= A1_start – 45; i += 4) A1.write(i); // 0 → 55 for (int i = A2_start + 60; i >= A2_start + 3; i -= 2) A2.write(i); // 135 → 78
delay(300);
krs.setPos(1, nongrip);
delay(300);
for (int i = A1_start – 45; i <= A1_start – 30; i += 5) A1.write(i); // 55 → 70 for (int i = A2_start + 3; i >= A2_start – 15; i -= 5) A2.write(i); // 78 → 60
delay(300);
krs.setPos(1, grip);
delay(300);
for (int i = A2_start – 15; i <= A2_start + 3; i += 5) A2.write(i); // 60 → 78 for (int i = A1_start – 30; i <= A1_start – 12; i += 5) A1.write(i); // 70 → 88 krs.setPos(1, lowgrip); } else { //保持ボックスなし have = 1; for (int i = A1_start – 100; i <= A1_start – 25; i += 10) A1.write(i); // 0 → 75 for (int i = A2_start + 60; i >= A2_start – 15; i -= 10) A2.write(i); // 135 → 60
for (int i = A2_start – 15; i <= A2_start; i += 5) A2.write(i); // 60 → 75 for (int i = A1_start – 25; i <= A1_start; i += 5) A1.write(i); // 75 → 100 delay(300); krs.setPos(1, nongrip); delay(500); A2.write(A2_start – 15); //60 delay(450); krs.setPos(1, grip); delay(450); A2.write(A2_start + 5); //80 delay(450); krs.setPos(1, nongrip); A2.write(A2_start); //75 delay(200); } moveTo(80); moveTo(-400); digitalWrite(2, LOW); } // ===== 自分より低い段から回収(-200mm) ===== void getBox_down() { digitalWrite(2, HIGH); krs.setPos(1, nongrip); readUARTData(); if (abs(results[5]) > 15) { //絶対値20以上のとき発動
turnTo(map(results[5], -170, 170, 60, -60), 1);
moveTo(150);
turnTo(0, 1);
} else moveTo(150);
krs.setPos(5, 4895); //ヘッド回収機構の干渉防止(kokokaratuika)
krs.setPos(4, 4765);
delay(100);
FL3.write(FL_start – 51); //95
FR1.write(FR_start + 51); //86
BL4.write(BL_start – 35); //後輪接地
BR2.write(BR_start + 35);
delay(500);
// —– 床検知の動作 —–
int n = 0;
while (true) {
unsigned int distance = getDistanceCM(URTRIG_F, URECHO_F);
if (distance > 10) n++; //前方は条件満たしてる?
if (n > 2) break; //条件を満たした回数でbreak
MOTOR1.set_speed(50); //moveToは前足を上げてしまうため
MOTOR2.set_speed(-50);
MOTOR3.set_speed(-50);
delay(25);
}
moveTo(-200); //前進し過ぎるので一旦後進
// —– アーム展開 —–
for (int i = A1_start; i >= A1_start – 60; i -= 5) A1.write(i); // 100 → 40
for (int i = A2_start; i <= A2_start + 90; i += 5) A2.write(i); // 75 → 165 moveTo(225); //少し前進 krs.setPos(1, grip); //ボックス保持 delay(300); if (digitalRead(IR_PIN_Box) == LOW) { //1ボックス設置済み have = 2; for (int i = A1_start – 60; i <= A1_start – 12; i += 10) A1.write(i); // 40 → 88 for (int i = A2_start + 90; i >= A2_start – 9; i -= 3) A2.write(i); // 165 → 66
delay(450);
krs.setPos(1, nongrip);
for (int i = A1_start – 12; i >= A1_start – 37; i -= 2) A1.write(i); // 88 → 63
for (int i = A2_start – 9; i >= A2_start – 25; i -= 2) A2.write(i); // 66 → 50
delay(300);
krs.setPos(1, grip);
delay(300);
A1.write(A1_start – 45); //55
delay(100);
A2.write(A2_start – 10); //65
delay(100);
A1.write(A1_start – 12); //88
krs.setPos(1, lowgrip);
} else { //ボックス未設置
have = 1;
for (int i = A1_start – 60; i <= A1_start + 5; i += 10) A1.write(i); // 40 → 105 for (int i = A2_start + 90; i >= A2_start – 10; i -= 5) A2.write(i); // 165 → 65
for (int i = A1_start + 5; i <= A1_start + 20; i += 5) A1.write(i); // 105 → 120 delay(300); krs.setPos(1, nongrip); for (int i = A1_start + 20; i >= A1_start; i -= 10) A1.write(i); // 120 → 100
for (int i = A2_start – 10; i <= A2_start; i += 10) A2.write(i); // 65 → 75
krs.setPos(1, nongrip);
delay(450);
A2.write(A2_start – 5); //70
delay(450);
krs.setPos(1, grip);
delay(450);
A2.write(A2_start + 5); //80
delay(450);
krs.setPos(1, nongrip);
A2.write(75);
delay(200);
}
moveTo(-400);
digitalWrite(2, LOW);
}

readUARTData.ino

/*———————–

ラズパイからの画像認識結果

 RaspberryPi5 – TX = 14

 ESP32wroom   – RX = 5

 M5stack      – RX = 36

————————*/

// results[5] は定義済み

void readUARTData() {

  static char rx_buf[64];

  static int rx_idx = 0;

  while (Serial1.available() > 0) {

    char c = Serial1.read();

    //Serial.write(c);  // 受信した文字をそのまま表示

    if (c == ‘\n’) {

      rx_buf[rx_idx] = ‘\0’;

      int r0, r1, r2, r3, r4, r5, r6;

      if (sscanf(rx_buf, “S,%d,%d,%d,%d,%d,%d”, &r0, &r1, &r2, &r3, &r4, &r5) == 6) {

        results[0] = r0;  //0:通信不可, 1:赤, 2:青

        results[1] = r1;  //左(1m以内) 0:Real, 1:Fake, 2:none

        results[2] = r2;  //右(1m以内)

        results[3] = r3;  //前(1m以内)

        results[4] = r4;  //前(1m以上)

        results[5] = r5;  //前中央箱の座標

      }

      rx_idx = 0;

    } else if (rx_idx < 63) {

      rx_buf[rx_idx++] = c;

    }

  }

}

Put_Box.ino

/*———

ブック設置

———–*/

void Put_Box2() {  //2段目

  digitalWrite(2, HIGH);

  delay(2000);      //短くしたい

  if (have == 2) {  //2つ保持

    krs.setPos(1, 8700);

    A1.write(72);

    /*A2.write(75);

    for (int i = 100; i >= 72; i -= 4) A1.write(i);  // 100 → 78*/

    for (int i = 63; i >= 55; i -= 2) A2.write(i);  // 65 → 55

    krs.setPos(1, 4000);

    delay(300);

    for (int i = 72; i >= 0; i -= 3) A1.write(i);   // 100 → 78

    for (int i = 55; i <= 74; i += 2) A2.write(i);  // 55 → 70

    delay(50);

    krs.setPos(1, 8700);  //離す

    delay(300);

    for (int i = 0; i <= 20; i += 5) {

      float ratio = i / 20.0;

      int a1 = 0 + (20 – 0) * ratio;    // 0 → 20

      int a2 = 75 + (90 – 75) * ratio;  // 75 → 90

      A1.write(a1);

      A2.write(a2);

    }

    for (int i = 20; i <= 100; i += 5) A1.write(i);  // 20 → 100

    for (int i = 90; i >= 75; i -= 5) A2.write(i);   // 90 → 75

    delay(200);

  } else if (have == 1) {  //1つ保持

    krs.setPos(1, 8700);

    delay(300);

    A1.write(100);

    A2.write(75);

    delay(500);

    A1.write(115);

    delay(500);

    A2.write(65);

    krs.setPos(1, 4000);

    delay(300);

    for (int i = 78; i >= 0; i -= 3) A1.write(i);   // 78 → 0

    for (int i = 65; i <= 75; i += 3) A2.write(i);  // 65 → 75

    delay(50);

    krs.setPos(1, 8700);

    delay(100);

    A2.write(62);  //素早く再保持地点へ移動

    delay(300);

    krs.setPos(1, 4000);  //掴みなおす

    delay(500);

    for (int i = 62; i <= 75; i += 3) A2.write(i);  //60→70

    delay(500);

    krs.setPos(1, 8700);

    delay(500);

    for (int i = 0; i <= 100; i += 8) A1.write(i);  // 0 → 100

  }

  digitalWrite(2, LOW);

  have–;

}

void Put_Box3() {  //3段目

  digitalWrite(2, HIGH);

  delay(2000);      //短くしたい

  if (have == 2) {  //2つ保持

    //A1.write(100);

    //A2.write(75);

    krs.setPos(1, 8700);

    delay(300);

    for (int i = 72; i <= 73; i += 1) {

      A1.write(i);  // 72 → 76

      delay(3);

    }

    for (int i = 63; i >= 60; i -= 1) {

      A2.write(i);  // 78 → 55

      delay(3);

    }

    krs.setPos(1, 3700);

    delay(300);

    for (int i = 55; i <= 70; i += 7) A2.write(i);  // 55 → 70

    for (int i = 76; i >= 1; i -= 7) A1.write(i);   // 78 → 3

    delay(200);

    krs.setPos(1, 8700);  //離す

    delay(500);

    /*A2.write(59);

    krs.setPos(1, 4000);  //掴みなおす

    A2.write(74);

    delay(100);

    krs.setPos(1, 8700);

    delay(300);*/

    for (int i = 1; i <= 20; i += 5) {

      float ratio = i / 20.0;

      int a1 = 3 + (20 – 3) * ratio;    // 0 → 20

      int a2 = 70 + (90 – 70) * ratio;  // 75 → 90

      A1.write(a1);

      A2.write(a2);

    }

    for (int i = 20; i <= 100; i += 5) A1.write(i);  // 100 → 78

    for (int i = 90; i >= 75; i -= 5) A2.write(i);   // 75 → 65

    //delay(200);

  } else if (have == 1) {  //1つ保持

    krs.setPos(1, 8700);

    A1.write(100);

    A2.write(75);

    delay(500);

    A1.write(115);

    delay(500);

    A2.write(65);

    krs.setPos(1, 4000);

    delay(300);

    for (int i = 78; i >= 0; i -= 5) A1.write(i);   // 78 → 0

    for (int i = 65; i <= 73; i += 4) A2.write(i);  // 65 → 70

    delay(50);

    krs.setPos(1, 8700);

    delay(100);

    A2.write(67);  //素早く再保持地点へ移動

    delay(350);

    //krs.setPos(1, 4000);  //掴みなおす

    delay(500);

    for (int i = 67; i <= 75; i += 4) A2.write(i);  //65→75

    delay(500);

    krs.setPos(1, 8700);

    delay(500);

    for (int i = 0; i <= 100; i += 8) A1.write(i);  // 0 → 100

  }

  digitalWrite(2, LOW);

  have–;

}

arina.ino

/*———

アリーナ

———–*/

void arina() {

  krs.setPos(4, 3500);  //下げる

  krs.setPos(5, 3500);  //下げる

  FL3.write(FL_start);

  FR1.write(FR_start);

  BL4.write(BL_start);

  BR2.write(BR_start);

  MOTOR1.stop(false);

  MOTOR2.stop(false);

  MOTOR3.stop(false);

  // 1. 指定の範囲内かつボックスが載るまでループ

  int val = analogRead(dis_PIN_R);

  if (have != 0) {

    for (int i = 100; i >= 72; i -= 4) A1.write(i);  // 100 → 72

    for (int i = 75; i >= 63; i -= 2) A2.write(i);   // 75 → 63

    krs.setPos(1, 4800);                             //ハンド

  } else {

    A1.write(A1_start);

    A2.write(A2_start);

    krs.setPos(1, 8700);  //ハンド

  }

  while (true) {

    val = analogRead(dis_PIN_R);  //更新

    krs.setPos(2, 4900);          //ハンド閉じる

    krs.setPos(3, 4900);

    if (have == 0 && digitalRead(IR_PIN_Box) == 0) have = 1;  // 積荷センサーのチェック

    if ((val > 1200 && val < 2000) && have != 0) break;       //位置が範囲内&&ボックスがある

    delay(10);

  }

  int base_val = (analogRead(dis_PIN_R) + analogRead(dis_PIN_R) + analogRead(dis_PIN_R)) / 3;  // 3回の平均

  int low_count = 0, high_count = 0;                                                           // チャタリング防止用のカウンター

  // 2. モーション発動するまでループ

  while (true) {

    val = analogRead(dis_PIN_R);  //更新

    krs.setPos(1, 4800);          //ハンド半開き?

    krs.setPos(2, 6000);          //ハンド開く

    krs.setPos(3, 6000);

    // — 条件判定(カウント処理) —

    if (val < base_val – 350) low_count++;   //3段目(値が小さくなる側)の判定

    else low_count = 0;                      // 外れたらリセット

    if (val > base_val + 800) high_count++;  // 2段目(値が大きくなる側)の判定

    else high_count = 0;                     // 外れたらリセット

    // — 3回連続で満たしたら実行 —

    if (low_count >= 3) {

      //krs.setPos(1, 4800);

      Put_Box3();  // 3段目へ

      break;

    }

    if (high_count >= 3) {

      //krs.setPos(1, 4800);

      Put_Box2();  // 2段目へ

      break;

    }

    delay(10);

  }

}

次回はgithub使えるようになっておきます…

おまけ(輸送)

輸送タスクは見落としがちですが、非常に労力を割くイベントです。

輸送箱の外観

B3サイズで印刷した紙をラミネートしています。
ビス止めした上から養生テープで保護してます。

輸送箱内部

ロボットはクッションを挟んで結束バンドでガチガチに固定しました。

被せてあるビニールは防水目的で、建物の塗装時に車に被せてあるアレです。

トラックに積まれる輸送箱と私

トラック大きかったです。

バンドで輸送箱を囲うように固定していただけるので安心です。

会場で開梱された輸送箱

ピットから少し離れた場所に輸送箱が置かれます。

つまり、会場で真っ先に、
・輸送箱を解体
・ロボットと工具類を取り出す
・運ぶ
という工程が立ちはだかります。

ピットクルーは初日の朝から必要です。

また、初日の朝は早いうちに会場入口で並んでおきましょう。

まとめ

練習通りではなかったものの、とりあえずロボットが動いている姿をお見せできて良かったです。

いままでは目標を「出場」としていましたが、想定より1年早く出場できたことから、来年の目標を「優勝」と設定することができました。

これからも頑張って参ります。

またいつか。

]]>
/nhk%e5%ad%a6%e7%94%9f%e3%83%ad%e3%83%9c%e3%82%b3%e3%83%b32026%e3%83%ad%e3%83%9c%e3%83%83%e3%83%88%e7%b4%b9%e4%bb%8b/feed/ 0
カグテン行ってみた‼︎ /%e3%82%ab%e3%82%b0%e3%83%86%e3%83%b3%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%e2%80%bc%ef%b8%8e/ /%e3%82%ab%e3%82%b0%e3%83%86%e3%83%b3%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%e2%80%bc%ef%b8%8e/#respond Wed, 22 Jul 2026 02:00:00 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=3893

みなさんこんにちは(^ ^)

みなさんは大学の中にある円形ギャラリーは知っていますか??

今回はその円形ギャラリーでの展示に行ってきました✨

私も所属する学科の空間演出デザイン演習ⅡAで制作した作品の展示です!

17号館のコミュニケーションラウンジの一部が

????ココ

カフェになったと想定して

“人と人とのコミュニケーションをさそうあたらしい木製家具をデザインする"

という課題でした〜

in円形ギャラリー

展示の様子

リサーチブックと作品

作品(一部のみ)

机を作った人もいれば椅子や棚などいろんなアイディアの作品がありました☆*:.。. o(≧▽≦)o .。.:*☆

展示も出品した学生たちが設置したりしているのでどうやって使うかなどが分かりやすい展示でした!

制作の期間が1Qの7週間で、リサーチ、制作をその間でやらなければならなかったのでほんっとうに大変だった

とおもいますが、全部の作品素晴らしかったです!!!!

円形ギャラリーではいろんな展示が定期的にされてるのでぜひ行ってみてくださいね!

]]>
/%e3%82%ab%e3%82%b0%e3%83%86%e3%83%b3%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%e2%80%bc%ef%b8%8e/feed/ 0
九芸卒展行ってみた! /%e4%b9%9d%e8%8a%b8%e5%8d%92%e5%b1%95%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%ef%bc%81/ /%e4%b9%9d%e8%8a%b8%e5%8d%92%e5%b1%95%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%ef%bc%81/#respond Thu, 26 Feb 2026 05:00:35 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=2922

みなさん明けましておめでとうございます、SUNです〜〜

今日は、卒業制作展に行ってきたので簡単な感想を書いてみたいと思います♪

私は、ビジュアルデザイン学科ですので、グラフィックデザイン専攻とイラストレーション専攻についてレポートしたいと思います。

2026年の卒展のテーマは、「BLOOM」

メインビジュアルはこちら!

かわいい〜〜〜〜〜〜!!!!!!!

華やかなデザインが、学内を明るくしてくれますね。

特別企画として、壁面を使った来場者参加型の「BLOOM LOOP」と「キュートーク」という教授とゼミ生によるクロストークが行われました。

(私は時間が合わずキュートークには行けませんでした。。。涙!来年もあるかな???????)

さて、本題

グラフィックデザイン専攻の作品

カカオは身体にいいらしいです。????チョコレート効果シリーズは太らないって聞きますよね

社会風刺の妖怪さんたち。戸が開く仕組みが面白い

????ラーメンのパッケージですね。ご当地ラーメンって意外と沢山、福岡県民としては要チェックの作品でした????

食品添加物や色についての研究です。

科学的な話は難しくて苦手ですが、グラフィカルな表現になるとついついみちゃいますね????

5階のアトリエをジャックして作られた空間は毎年圧巻です

✨優秀賞✨

雅楽の衣装をテーマに作られたそうで繊細な仕事です。上の方まで積み上がった多彩な切り絵は、大迫力!撮影禁止でしたが、背面には詳細な内容やリーフレットなどが掲示されていました。

動物の視野についての研究です。蛇腹本の穴を覗くと、実際に見える景色が広がってました、再現するのがすごい

優秀賞は作品の規模が大きい印象です

今年のグラフィックの作品はインフォグラフィックスが多く利用されていました。

ーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーーー

イラストレーション専攻の作品

かつて憧れたヒロインたちをギュッと集めた作品で釘付け????人気投票があったので、名前が一緒でシンパシーを感じた紫の女の子に一票入れました!(変身前の性格やチャームポイントもどことなく似ていました運命?)

ポップアップの絵本が展示されていましたが、写真撮影可か分からなかったので撮れませんでした????木の台座に乗っていて、絵本の世界にトリップできる空間でした????

イラストレーション専攻は、ゲーム体験や撮影ブースなど体験型展示が多くて楽しめました

今回は、ビジュアルデザイン学科のレポートのみですが、実際の会場にはプロダクトや服飾、絵画など多岐にわたる展示がされています!

様々なテーマで制作される作品は、大学四年間の集大成!私も頑張るぞ〜〜〜〜!

毎年、期間は短いですが学内で展示が行われていますので、ぜひ足を運んでくださいね????

↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓

]]>
/%e4%b9%9d%e8%8a%b8%e5%8d%92%e5%b1%95%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%ef%bc%81/feed/ 0
書き初めイベント???? /%e6%9b%b8%e3%81%8d%e5%88%9d%e3%82%81%e3%82%a4%e3%83%99%e3%83%b3%e3%83%88%f0%9f%8e%8d/ /%e6%9b%b8%e3%81%8d%e5%88%9d%e3%82%81%e3%82%a4%e3%83%99%e3%83%b3%e3%83%88%f0%9f%8e%8d/#respond Sat, 28 Feb 2026 09:18:27 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=3020

こんにちは˙ ͜ʟ˙

新年あけてだいぶ経ちましたが

あけましておめでとうございます( ◠‿◠ )

今年もよろしくお願いいたします!

新年ということで、K*RISEでは、書き初めイベントを行いました!

今日はその様子を公開しまーす♩

6人で書き初めたので、みんなの抱負を紹介します( ◠‿◠ )

1人目????‍♀️

私の今年の2026年度の文字は「グラタン」でした〜✨

2人目????‍♀️????‍♂️

私の今年の目標はこの学生広報をちゃんと継続的に存続させることです❗️

3人目????‍♀️????‍♂️????

私の今年の漢字は「筋トレ」理由は毎年筋トレ頑張ろうって決意してるのにダラダラしちゃってるから、今年こそは❗️九産大のジムで頑張りま〜す????

4人目????‍♀️????‍♂️????????‍♀️

私の今年の目標は猫を愛でることで〜す????

5人目????‍♀️????‍♂️????????‍♀️????‍♂️

私の目標は全身全霊で物事に取り組むことと、クレープパーティーを開催することです✨

6人目????‍♀️????‍♂️????????‍♀️????‍♂️????

まあ笑っていればなんとかなるということで、今年の漢字は「笑」でーす( ◠‿◠ )

こんな感じでみんなで書き初めを行いましたー♩

クレープパーティは絶対開きたいです❗️

皆さんも書き初めてみてくださ〜い????

]]>
/%e6%9b%b8%e3%81%8d%e5%88%9d%e3%82%81%e3%82%a4%e3%83%99%e3%83%b3%e3%83%88%f0%9f%8e%8d/feed/ 0
立花寮合宿ガイド /%e7%ab%8b%e8%8a%b1%e5%af%ae%e5%ae%bf%e6%b3%8a%e3%82%ac%e3%82%a4%e3%83%89/ /%e7%ab%8b%e8%8a%b1%e5%af%ae%e5%ae%bf%e6%b3%8a%e3%82%ac%e3%82%a4%e3%83%89/#respond Thu, 19 Mar 2026 08:45:36 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=3068

立花寮に泊まれるのは遠方の学生で一人暮らしの学生のみだと思っていませんか・・・?

実家暮らしには縁が無いよな〜????

私もバリバリ実家暮らしなので、寮に泊まれる未来なんて無いと思っていました。

しかしなんと!きちんと申請をすればお泊まり気分で大学の寮に泊まれちゃうのです♪

今回は『RISE合宿』主催者が、寮に泊まる手引きをお伝えします????この方法は部活での合宿利用や、大学から家までわざわざ帰るのが面倒な時におすすめかも!?!?!?

まずは申請をしてみよう!

お泊まりしたいと思いったたらまずは厚生課に電話をしてみましょう!!基本寮での宿泊手続きは厚生課が担っています。

注意:この段階で立花寮へ電話してはいけません。一般学生の宿泊手続きは厚生課管轄らしいのでね。(もちろん私は勘違いして最初は寮に連絡をしていました)

電話では「宿泊利用したい」などの旨を伝えましょう。そしたら厚生課の方が担当して引き続きの動きのことを教えていただけます。

レッツ厚生課

 厚生課に行ったら書類をもらいます。私がもらった必要書類はこちら(間違いがあったらすいません)

・立花寮の施設情報が載ったプリント

・宿泊目的などを記載するプリント

・布団レンタルのプリント

・宿泊者の個人名を記載するプリント

こちらの4枚をもらいます。1枚づつ説明すると

・立花寮の施設情報が載ったプリント

これは寮の概要が載っています。どんな施設なのか、何が備わっているのか、など。一階には卓球施設があるので卓球もできますよ♪

・宿泊目的などを記載するプリント

こちらは、『何のために宿泊するのか』『代表者』『団体名』などを記載するプリントです。

・布団レンタルのプリント

皆さんも気になったであろうこのプリント。寮では素泊まりはできなくて、お布団を外部の業者からレンタルしないといけないのです。(びっくり)これが少し大変で、外部との連絡を自分で行わないといけないので申請が少々大変でした。。。管轄も外部になるので完全に外注になります。(外注ですが、厚生課の指定する会社さんなので安心)

・宿泊者の個人名を記載するプリント

これはお泊まりする人の名前と個人の電話ばんごうを全員分書きます。人数が多いと手が疲れる作業です。

提出しよう

上記の紙が書けたら厚生課にGO!!!

確か2週間前に申請を完了しておく必要がありました。宿泊費は1人1200円くらいだった気がします。(布団代含む
)

ご飯は基本持参ですが、水は飲み水がありました。バスルームはなくて、共同のシャワールームがあります。ちなみにキャンセル料は宿泊日の三日前から発生するのでお気をつけて。。。

さて、これであなたもお泊まりできますね!さようならー????

]]>
/%e7%ab%8b%e8%8a%b1%e5%af%ae%e5%ae%bf%e6%b3%8a%e3%82%ac%e3%82%a4%e3%83%89/feed/ 0
博多の大学フェス 〜運営編〜 /%e5%8d%9a%e5%a4%9a%e3%81%ae%e5%a4%a7%e5%ad%a6%e3%83%95%e3%82%a7%e3%82%b9%e3%80%80%e3%80%9c%e9%81%8b%e5%96%b6%e7%b7%a8%e3%80%9c/ /%e5%8d%9a%e5%a4%9a%e3%81%ae%e5%a4%a7%e5%ad%a6%e3%83%95%e3%82%a7%e3%82%b9%e3%80%80%e3%80%9c%e9%81%8b%e5%96%b6%e7%b7%a8%e3%80%9c/#respond Tue, 16 Jun 2026 23:43:08 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=3488

みなさんこんにちは!

今回は5月6日に博多駅前広場にて行われた、はかたの大学フェスに参加したので紹介します!

私は運営なので、企画会議から参加しました!

入試部到着✨

入試部との話し合いは3ヶ月ほど前の2月から1回目の打ち合わせがスタートしました。

イベントそのものに参加するかどうかの話やPRブースをどのように計画するか話し合いました!

K*RISEとして出来ることとして

KSU VISION DAYみたいにチラシ配りなどの活動が出来るなど話しました!

イベントでK*RISEが来場者に何か配りたい!ということで

入試部へ芸術学部がデザインしたバッグを提案しました!
芸術学部がデザインしたバッグ↓

個人的には、○ △ □ *
のシンプルなところが気に入ってます!

入試部の方たちは親切で話しやすかったです!

前日は、台車にK*RISE出展荷物を乗せて12号館から1号館まで運営メンバーで運びました!

途中坂道があって落ちないかなと心配しながら運びました!

朝1番に博多駅前広場に到着しました!

荷物の搬入をしてセッティングを行いました!

セッティング完了✨

3×3のスペースって思ったより小さい????

結果としてK*RISEがはかたの大学フェスにスタッフとして参加できたのは良かったと思いました。

高校生とや保護者だけでなく、小さい子連れの家族からお年寄りの方まで幅広い来場者が九産大のブースに興味を持ってくれたのは凄く嬉しかったです。

入試部の方と協力して高校生や地域の方に九産大の魅力を少しでも伝えられて良かった。
芸術/2年 

高校生だけでなく色々な方が興味を持ってくれてよかった。
芸術/2年 

どんな人が大学の情報を求めているのかを知れてよかったです。
芸術/3年

高校生や大学生、保護者の方など多くの方と接するいい機会になった。
生命/2年 

みなさん朝からチラシ、パンフレット、バッグの配布お疲れ様です!

K*RISEメンバーからもかなり好評をいただくことができました!

また、K*RISEにイベントの依頼が来た時にはイベントに参加したいと思いました!

]]>
/%e5%8d%9a%e5%a4%9a%e3%81%ae%e5%a4%a7%e5%ad%a6%e3%83%95%e3%82%a7%e3%82%b9%e3%80%80%e3%80%9c%e9%81%8b%e5%96%b6%e7%b7%a8%e3%80%9c/feed/ 0
九産大オープンキャンパス潜入レポート!ユニークな体験から限定グルメまで大公開 /%e3%82%aa%e3%83%bc%e3%83%97%e3%83%b3%e3%82%ad%e3%83%a3%e3%83%b3%e3%83%91%e3%82%b9%e3%81%ab%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%ef%bc%812025-07-20/ /%e3%82%aa%e3%83%bc%e3%83%97%e3%83%b3%e3%82%ad%e3%83%a3%e3%83%b3%e3%83%91%e3%82%b9%e3%81%ab%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%ef%bc%812025-07-20/#respond Sat, 26 Jul 2025 23:00:00 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=967

2025年7月20日(日)に開催された、九州産業大学のオープンキャンパスにK*RISEメンバーが潜入!
みんなにぜひ行ってほしい、おすすめスポットをたくさん見つけてきたよ!チェックしてみてね♪

学び・発見編

\ 経済 × カードゲーム????/

カードを使ってお金の流れや経済の仕組みを楽しく学べる!
大学生や友達と対戦しながらゲーム感覚で学べるから、経済の知識がなくても楽しめるよ!

経済学科 1号館2階N202教室


\ 自分だけの練り香水作り❤︎ /

日本文化学科では自分だけの練り香水が作れちゃう!
好きな色や香りを選んで、オリジナルの香水づくりにチャレンジ!
楽しみながら、日本の文化にふれてみよう!

日本文化学科 2号館4階 2E401・2E402教室


\ 自分の性格を分析!/

チェックリストに答えるだけで、自分の性格がまるわかり!
家族や友達との性格の違いも見えてくるかも?????

臨床心理学科 3号館3階 3306AB教室


\ 折り紙で制作体験 /

折り紙を使って、夏をテーマにした壁面づくりを体験!子ども教育学科の学生がサポートしてくれながら制作できるから安心????

子ども教育学科 3号館 2階 図工室


\理系女子のための相談会????????/

理系を目指す女子必見‼︎????????
理工学部の女子生徒と直接お話ができる!
勉強のことや進路の不安、気になることを気軽に相談してみよう♪

理工学部 12号館 1階 ロビー


\ VRを使って英会話????️????/

VRを使ってAIと英会話をしたり、ネイティブの先生とおしゃべりができる!
英語がグッと身近に感じられるはずだよ!

語学教育センター 2号館 1階 グローバルプラザ


\ 芸術学部生の作品展示????????‍???? /

芸術学部各学科の生徒がつくった作品を展示!
映像や写真、イラスト他にもいろんなジャンルの作品が見られる貴重な機会!

芸術学部 各教室
(写真:17号館5階 GD・ILD共同デザインアトリエ)


\ 理工学部生の作品展示????‍????????  /

12号館では理工学部の各学科のユニークな作品がたくさん展示されていたよ!液体窒素を使った実験や、介護に役立つ機械の紹介など、思わず見入ってしまうものばかり!

(写真:12号館2階)

食べ物編

\ドリンクを無料でゲット????/

30度超えの暑さで歩き回るから、飲み物はマスト????☀️
受付でもらえるパンフレットにはドリンク引換が記載されているよ!ドリンクを受け取ったら忘れずにチェックして貰おう!

一号館前広場のステージ、総合情報基盤センター前


\ 映え食べ物でエネルギーチャージ⚡️/

一号館目の前の広場にキッチンカーが出店!
写真映えも味もバッチリで、大満足まちがいなし????

一号館前広場


\ 学食でお昼を食べてみよう!/

授業のある日は席を取るのも食券を買うのも一苦労な学食????
定食から麺類、カレーなど種類も豊富!
ぜひ一度九産の学食を食べてみて!

中央会館1階 アルテリア(写真)
8号館1階 クラブハウス

気になるスポットはあったかな?
他にも入試のための説明会、個別相談会、パネル展示など各学部様々なイベントが行われているよ!
ぜひ九州産業大学のオープンキャンパスに遊びにきてね!

]]>
/%e3%82%aa%e3%83%bc%e3%83%97%e3%83%b3%e3%82%ad%e3%83%a3%e3%83%b3%e3%83%91%e3%82%b9%e3%81%ab%e8%a1%8c%e3%81%a3%e3%81%a6%e3%81%bf%e3%81%9f%ef%bc%812025-07-20/feed/ 0
九州産業大学 芸術学部 〜プロジェクションマッピング Lantopia????〜 /lantopia%e3%80%9c%e8%8a%b8%e8%a1%93%e5%ad%a6%e9%83%a8-%e3%83%97%e3%83%ad%e3%82%b8%e3%82%a7%e3%82%af%e3%82%b7%e3%83%a7%e3%83%b3%e3%83%9e%e3%83%83%e3%83%94%e3%83%b3%e3%82%b0%f0%9f%8e%84%e3%80%9c/ /lantopia%e3%80%9c%e8%8a%b8%e8%a1%93%e5%ad%a6%e9%83%a8-%e3%83%97%e3%83%ad%e3%82%b8%e3%82%a7%e3%82%af%e3%82%b7%e3%83%a7%e3%83%b3%e3%83%9e%e3%83%83%e3%83%94%e3%83%b3%e3%82%b0%f0%9f%8e%84%e3%80%9c/#respond Thu, 22 Jan 2026 07:00:00 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=2811

みなさんこんにちは????

今日は
12月22日23日に行われていたソーシャルデザイン学科 情報デザイン専攻の学生さんが行っていたプロジェクションマッピング

「Lantopia」をご紹介!

授業終わりに北門へ向かう途中大きくて綺麗な映像が校舎に投影されていました✳︎

落ち着きのある音楽ととともに学生さんが作ったクリスマスの映像が建物一面に投影されており、
いつも通る道が、初めての場所に来たかのような空間に????♪
実際の時刻と連動している時計台や雪が降る街でクリスマスを楽しむ人々などカラフルで暖かな映像が流れていました

北門のすぐそばで行われていて門の外からも映像が見えるからか、学生だけでなく、小さなお子さんや大人の方まで大学に訪れていました

映像だけでなくココアやマシュマロの無料提供も!
映像の前では焚き火があるから焚き火でマシュマロを炙って食べました????????
寒い中食べる炙りマシュマロはフワトロ甘くてとっても美味しかったです


作成者の学生さんにお気に入り箇所を聞いたところ守衛室に投影されているパッチワークをイメージした映像だと教えてもらいました^^(写真↓)

作成者のソーシャルデザイン学科の生徒さん

<作成者コメント>
落ち着いた空間をコンセプトに作成しました。
暖かくファンタジーな空間を子どもから大人までたくさんに人に楽しんでもらいたいです。

落ち着く空間で寒くてもあたたかな気持ちになれる素敵なプロジェクションマッピングでした????☃️
プロジェクションマッピングはソーシャルデザインの学生さんによって不定期で行われているので見かけた際はぜひ訪れてみてください

See you〜 ^^/~~~

]]>
/lantopia%e3%80%9c%e8%8a%b8%e8%a1%93%e5%ad%a6%e9%83%a8-%e3%83%97%e3%83%ad%e3%82%b8%e3%82%a7%e3%82%af%e3%82%b7%e3%83%a7%e3%83%b3%e3%83%9e%e3%83%83%e3%83%94%e3%83%b3%e3%82%b0%f0%9f%8e%84%e3%80%9c/feed/ 0
「RISE合宿」に参加させていただきましたわ〜???? /%e3%80%8crise%e5%90%88%e5%ae%bf%e3%80%8d%e3%81%ab%e5%8f%82%e5%8a%a0%e3%81%95%e3%81%9b%e3%81%a6%e3%81%84%e3%81%9f%e3%81%a0%e3%81%8d%e3%81%be%e3%81%97%e3%81%9f%e3%82%8f%e3%80%9c%f0%9f%8e%89/ /%e3%80%8crise%e5%90%88%e5%ae%bf%e3%80%8d%e3%81%ab%e5%8f%82%e5%8a%a0%e3%81%95%e3%81%9b%e3%81%a6%e3%81%84%e3%81%9f%e3%81%a0%e3%81%8d%e3%81%be%e3%81%97%e3%81%9f%e3%82%8f%e3%80%9c%f0%9f%8e%89/#respond Thu, 11 Sep 2025 04:00:25 +0000 https://k-rise.cs.kyusan-u.ac.jp/?p=1689

みなさま、こんにちは✨

ミカエル・ミカエラでございます????

夏休みの間に第一回RISE合宿に参加いたしましたわ????

この記事を読まれている中高生や在学生の方々は、

RISE合宿???????

というかRISEとは???????という状況になっておりますよね。。。

では、本日はRISEの解説と合宿レポを行なっていきますわ♪♪♪

”RISE”とは??

RISEとは、

K*RISEのRISEですわ????

K*RISEと言われてもあまりピンときませんわよね・・・

K*RISEとは、

九州産業大学の公式学生広報団体

ですわ〜!

九産大の学生たちが、全国の中高生や在校生に向けて魅力や日々の日常について発信することを目的とした団体ですわ!

わたくしもメンバーの一人であり、こうやってみなさまに記事によって九産大の魅力や情報を発信しておりますの!

現在は、学生の中から有志たちが集まり、みんなで楽しく活動をしておりますわ☺️

そして!この広報団体の制作合宿が夏休みに行われましたの!!

と〜〜〜っても楽しかったので思い出を共有いたしますね♪♪♪

RISE合宿の思い出♡

RISE合宿は1泊2日で、Webサイト・SNSに掲載するための記事、写真、動画の集中的な制作を行うために開催されましたの!!

1人1作品!制作することがこのRISE合宿の目標ですわ!

お泊まりする場所はなんと!

九州産業大学の寮!「立花寮」ですわ!!

普段は本学1年生の学生が住んでいる場所なのですが、本学の学生でしたら申請をすれば誰でも使用可能ですの☺️

とっても便利ですわよね✨

2日間のタイムスケジュールはこんな感じ☟ですわ!

1日目は、個人制作やメインビジュアルの撮影行いましたわ〜! 

メインビジュアルの撮影風景ですわ〜!

わたくしは写真撮影を担当しましたわ!実際のメインビジュアルは、SNS広告や駅の広告として張り出す予定なので、ぜひお探しくださいまし????

SNSにアップする用の動画撮影も行いましたわ〜!1日目の午前中は雨が降っていたのですが、奇跡的に午後からは、太陽さんがお顔を出してくれて、無事に動画を撮影できましたの✨

こちらはわたくしのご友人ですわ〜????

お天気も良くなって気分もルンルンッ♪みたいですわね☺️

学校での活動が終わりましたら、いよいよ立花寮に移動ですわ〜!

寮の施設に関しましては、一緒にご参加いたしました”ぶちょー様”が丁寧なレポートを執筆してくださっておりますので、ぜひこちら☟をご覧くださいまし✨

寮に移動した後は、みんなで夜ご飯をいただきましたわ!

夜は、メンバーの方々とカードゲームで遊びましたわ!初対面の方もいらっしゃいましたが、この合宿を通してとっても仲良くなれましたの????

合宿2日目は、座談会動画の撮影や個人制作を行いましたわ〜!

座談会動画では、女の子と男の子に分かれて撮影しましたの♪

女の子の題材は、墓コスですわ〜????

みなさま、墓コスというワードはご存知でしたか??

墓コス=墓場まで持って行きたいくらい好きなコスメ

という意味だそうですよ♪

お恥ずかしながら、わたくしはこの撮影の時に初めて意味を知りましたわ????

こちらが撮影風景ですわ〜!みなさまのおすすめコスメを知ることができ、有力な情報をたくさん得ることができましたの♪たくさんの可愛いものを見れて幸せな時間でしたわ❤️

動画は、SNSの方にアップされるので、ぜひご覧くださいまし!

午後からはいよいよ制作のラストスパートですわ〜!!

1人1作品を達成するためにみなさま全力で制作していますわ〜!!

無事に、みなさま作品を完成させ、1人1作品以上を達成することができました✨

みなさま素晴らしいですわ〜????????

K*RISE初の合宿ということで、1日目の最初は不安も大きかったのですが、

ミカエル・ミカエラの初記事も執筆することができて、素材もたくさん撮影することができ、お天気にも恵まれて、最高の2日間でしたわ〜☺️

メンバーの方々とも仲を深められて、K*RISEでの活動がより楽しいものになりましたわ♪

この合宿で制作したものは、今後このWebサイトやSNSにアップする予定なので、ぜひご覧になってくださいまし????そして、これからもたくさんの魅力や情報をお届けして参りますので、ぜひご贔屓にしてくださいまし〜????

最後にK*RISEメンバーのみなさまがルンルンッしている写真で締めくくらせていただきますわ????

ここまで読んでくださったみなさま方、誠にありがとうございました✨

今後のK*RISEの活動に期待していてくださいまし????

]]>
/%e3%80%8crise%e5%90%88%e5%ae%bf%e3%80%8d%e3%81%ab%e5%8f%82%e5%8a%a0%e3%81%95%e3%81%9b%e3%81%a6%e3%81%84%e3%81%9f%e3%81%a0%e3%81%8d%e3%81%be%e3%81%97%e3%81%9f%e3%82%8f%e3%80%9c%f0%9f%8e%89/feed/ 0