編集履歴一覧に戻る
Daitonのアイコン画像

Daiton が 2021年02月07日18時22分59秒 に編集

コメント無し

本文の変更

久しぶりの投稿になります。 今回は自分とクラスメイトの計三人で開発したクローラロボットの制御方法と機構について紹介させていただきます。

-

**1. 研究の動機**

+

研究の動機

==== 私の通う高専の低学年自主研究のテーマとして比較的単純な構造をした小型クローラロボットを作ろうとしたのがきっかけです。

-

**2. 制御基板の紹介**

+

制御基板の紹介

==== DCモーターを最大4つ同時制御可能なL293Dモータードライバシールドを使用しました。モーターはRS380PHを用いました。 [](url)https://www.amazon.co.jp/L293D-ドライバー拡張ボード-基板モーター-モータ制御シールド-並行輸入品/dp/B011IGZ2CA/ref=sr_1_2?dchild=1&hvadid=474658879430&hvdev=c&jp-ad-ap=0&keywords=arduino+%E3%83%A2%E3%83%BC%E3%82%BF%E3%83%BC%E3%82%B7%E3%83%BC%E3%83%AB%E3%83%89&qid=1612524014&sr=8-2&tag=yahhyd-22 通信にはUSBホストシールドを使用しました。Bluetoothドングを差し込みps4のコントローラで操作できるようにしています。 [](url)https://www.amazon.co.jp/HAMILO-USBホストシールド-Arduino用-サイエンス-パソコン周辺機器/dp/B08685TRNJ/ref=sr_1_7?dchild=1&hvadid=467530877261&hvdev=c&jp-ad-ap=0&keywords=arduino+usb%E3%83%9B%E3%82%B9%E3%83%88%E3%82%B7%E3%83%BC%E3%83%AB%E3%83%89&qid=1612521806&sr=8-7&tag=yahhyd-22 電源はArduino本体用にモバイルバッテリー、モータードライバー用に9Vの電池を使いました。 配線を終えた基盤全体の図と写真です。

+

![キャプションを入力できます](https://camo.elchika.com/3c39d40197eb7623c3e867c6b4548ea56997a332/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f64323537326161302d393966392d346463312d383038642d6231656566336361376461622f32366633383363372d626461622d346437362d383034642d646165356431366262333833/) ![キャプションを入力できます](https://camo.elchika.com/b0586c16c72781f8a4b0dfac585fb1fbac2506c6/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f64323537326161302d393966392d346463312d383038642d6231656566336361376461622f37323666323538632d613565612d343936352d613636342d623735376636326639653161/)

-

**3. プログラム**

+

プログラム

====

+

```arduino:クローラロボットの制御 #include <AFMotor.h> #include<PS4BT.h> #include<usbhub.h> #ifdef dobogusinclude #include <spi4teensy3.h> #endif //#include <SPI.h> USB Usb; BTD Btd(&Usb); PS4BT PS4(&Btd, PAIR); bool printAngle, printTouch; uint8_t oldL2Value, oldR2Value; AF_DCMotor motor1(1, MOTOR12_64KHZ); //左側モータ AF_DCMotor motor3(3, MOTOR34_64KHZ); //右側モータ AF_DCMotor motor4(4, MOTOR34_64KHZ); //アームのモーター int pos_ry; int pos_ly; int motor_sp; const int motor_sp1 = 255; //旋回速度 const int motor_sp0 = 0; //低速 void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // Halt } Serial.print(F("\r\nPS4 Bluetooth Library Started")); motor1.run(RELEASE); motor3.run(RELEASE); motor4.run(RELEASE); } void loop() { Usb.Task(); { if (PS4.connected()) { pos_ly = PS4.getAnalogHat(LeftHatY); //y pos_ry = PS4.getAnalogHat(RightHatY); //x if (PS4.getButtonClick(UP)) { //アーム上げる motor4.run(FORWARD); } if (PS4.getButtonClick(DOWN)) { //アーム下げる motor4.run(BACKWARD); } if (PS4.getButtonClick(RIGHT)) { motor4.setSpeed(0); motor4.run(RELEASE); } //左スティックがセンター付近は停止 if (pos_ry >= 117 && pos_ry <= 137 && pos_ly >= 117 && pos_ly <= 137) { motor1.setSpeed(0); motor1.run(RELEASE); motor3.setSpeed(0); motor3.run(RELEASE); } //前進 else if (pos_ly < 117 && pos_ry < 117) { motor_sp = map(pos_ly, 117, 0, 0, 255); //map(fromlow,fromhigh,tolow,tohigh)に変換 motor1.setSpeed(motor_sp); motor1.run(FORWARD); motor3.setSpeed(motor_sp); motor3.run(FORWARD); } //後進 else if ( pos_ly > 137 && pos_ry > 137) { motor_sp = map(pos_ly, 137, 255, 0, 255); motor1.setSpeed(motor_sp); motor1.run(BACKWARD); motor3.setSpeed(motor_sp); motor3.run(BACKWARD); } //時計回り else if (pos_ly < 117 && pos_ry > 137) { motor1.setSpeed(motor_sp1); motor1.run(FORWARD); motor3.setSpeed(motor_sp1); motor3.run(BACKWARD); } //反時計回り else if (pos_ly > 137 && pos_ry < 117) { motor1.setSpeed(motor_sp1); motor1.run(BACKWARD); motor3.setSpeed(motor_sp1); motor3.run(FORWARD); } } } } ``` このコードはgithubにも公開しています。[](url)https://github.com/akimoto-tt/crawlerRobot/blob/main/robotSketch コントローラの配置は以下の通りです。 ![キャプションを入力できます](https://camo.elchika.com/ba8e0118447d6489d705b87bf904e6f3a8d00440/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f64323537326161302d393966392d346463312d383038642d6231656566336361376461622f62336663303666342d373132302d346463352d386239622d363763326236386562376436/)

-

**4. 機構と本体の紹介**

+

機構と本体の紹介

==== 先端にホイールをつけたアームを楕円軌道上に作動させることで履帯(キャタピラ)を変形させ障害物を踏破します。 ![キャプションを入力できます](https://camo.elchika.com/8d9f57e90c4e402a4572ce389808bf436cd6e832/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f64323537326161302d393966392d346463312d383038642d6231656566336361376461622f64373565333030652d333232642d343963382d623537342d343364616461393761363864/) また小型化のためギアボックスの自作もしました。 ![キャプションを入力できます](https://camo.elchika.com/2d558705ef391b8ea0035907a2da2bbbc825018f/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f64323537326161302d393966392d346463312d383038642d6231656566336361376461622f61393038616263632d356238642d346263392d386465332d393464343235333762646261/) 設計はCAD(solidworks)で行い製造はプラスチックをレーザー加工したり3Dプリンタを用いました。全体の3Dデータは以下の通りです。 ![キャプションを入力できます](https://camo.elchika.com/3955a140d238fa27a6f234421419092146d3f855/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f64323537326161302d393966392d346463312d383038642d6231656566336361376461622f39303033396164382d373063392d346531362d383261302d376439383131303033383130/)

-

**5. 総括**

+

総括

==== コロナ下で休校が続く中でなるべく簡略化した制御方法をとることができました。簡単な制御方法と製造までスピーディに行えたことが発表会でも評価していただけました。 ![キャプションを入力できます](https://camo.elchika.com/689e7ad433eef542dadac0d9eabfe2dd4a9eb23c/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f64323537326161302d393966392d346463312d383038642d6231656566336361376461622f62653062313864632d633431312d343930332d386539652d363861396438326130326633/) 新学期からもこのロボットの改良を続けセンサやカメラを搭載したりWi-Fiモジュールなどを活用したいと思っています。 つたない文章でしたがありがとうございました。