クローラロボット開発プラットフォームの初心者向けサンプルコードはこちらをご参照ください
https://github.com/CuboRex-Development/cugo-arduino-beginner-programming

旧製品のArduinoKitの方はこちらをご覧ください。
https://github.com/CuboRex-Development/cugo-sdk-samples/tree/uno

これはクローラロボット開発プラットフォームをより発展的に使うために、さまざまな便利関数をまとめたサンプルコードです。CuGoを動かす各種関数等を説明します。

クローラロボット開発プラットフォームの利用開始までの手順を説明します。

1. 公式ページ( https://www.arduino.cc/en/software )へ移動
2. DOWNLOAD OPTIONSからご自身のOSのバージョンを選択
3. JUST DOWNLOADかCONTRIBUTE & DOWNLOADを選択
4. ダウンロードされたらファイルを実行して指示に従いインストール

1. Codeボタンを選択し、Download ZIPをクリックしてダウンロード

2. ダウンロードしたファイルを解凍

3. CugoSDKSample.inoをダブルクリックし、Arduino IDEを起動

Arduino IDE でRaspberryPiPicoに書き込む場合、IDEにRaspberryPiPicoのボード情報をあらかじめ取得する必要があります。

Arduino IDE バージョン2系（最新版）の場合

1. ファイル ＞ 環境設定を選択
   

2. 追加のボードマネージャのURLに以下のURLを入力し、OKを押します。右のウィンドウボタンをクリックすると入力できるようになります。
   https://github.com/earlephilhower/arduino-pico/releases/download/global/package_rp2040_index.json
   

3. ツール ＞ ボード ＞ ボードマネージャ…を選択

4. "pico"で検索し、”Raspberry Pi Pico/RP2040”を見つけます。”INSTALL”ボタンを押します（すでに入っている場合はUPDATEボタンを押して最新にします）。

5. スケッチ ＞ ライブラリをインクルード… ＞ ライブラリを管理…を選択

6. RPi_Pico_TimerInterrupt.hで検索し、”RPI_PICO_TimerInterrupt”を見つけます。”INSTALL”ボタンを押します（すでに入っている場合はUPDATEボタンを押して最新にします）。

Arduino IDE バージョン1.8.19（レガシー）の場合

Pythonの'encoding'モジュールが見つからないエラーでビルドできない場合

クローラロボット開発プラットフォームには、V3iモデルとV4モデルがあります。各モデルごとに制御パラメータが異なる場所がありますので、確認をしてください。

Arduino IDE上部タブから”CugoSDK.h”を選択

下記パラメータを使用しているモデルに合わせます。

プログラムが下の図と同じになるように必要に応じてプログラムを書き換え、ご自身のモデルのパラメータが反映されるように調整してください。

V4の場合
”CugoSDK.h”は、サンプルプログラムから変更する必要はありません。

V3iの場合
”CugoSDK.h”の12行目から17行目の行頭に//を追記し、19行目から24行目の行頭の//を削除します。

1. CugoBeginnerProgramming.inoがArduino IDEで開かれていることを確認

2. USBケーブルでパソコンとRaspberry Pi Picoを接続。PCに認識されないときは基板にある”BOOTSEL”ボタンを押しながらPCに挿してください。
   

3. ツール ＞ ボード ＞ Raspberry Pi Pico/RP2040 ＞ Rasberry Pi Pico を選択

4. ツール ＞ ポート からRasberry Pi Picoのポートを選択します。ポートはUSBを接続する前と後を比較して増えたものがRaspberry Pi Picoなので、それを選択します。
   USBを接続する前↓
   

USBを接続した後↓

8. 矢印ボタン " → "を選択し、マイコンボードへ書き込むを実行
   

9. ボードへの書き込みが完了しましたの記載があれば書き込み完了です。

クローラロボット開発プラットフォームでは、安全のため、出荷時にプログラム動作する、コマンドモードを無効化しています。
以下の図に従って、電源が切れていることを確認し、DIPスイッチの2番をON側に倒してください。大変小さなスイッチですので、つまようじなどを用意して操作してください。
詳細は、取扱説明書をご覧ください。
https://drive.google.com/drive/folders/18MQUVMLYS_4JgkeGd2v7dVHmdmFaMaZc?usp=drive_link

クローラロボット開発プラットフォームでは2つのモードが利用できます

ラジコンモードはCugoSDKSample.inoを書き込み後、付属のコントローラの左スティックを左側に倒すことでラジコンモードが開始します。

ラジコンモードでの操作方法は

• 左スティックの上下操作が左クローラーの前進後進移動
• 右スティックの上下操作が右クローラーの前進後進移動　
  

になります

• CuGoSDKSampleにて自作関数を利用する場合はloop内の //ここから自動走行モードの記述から //ここまで自動走行モードの記述までに記載してください。
• loop()のif()により、ラジコンモードの実装とプログラムモードの実装を記載しております。このプログラムモードのブロック内を編集していください。

void loop() {

  //プロポ入力によりcugo_run_modeが変化
  if(cugo_runmode == CUGO_RC_MODE){//ラジコンモード
    ld2_set_control_mode(CUGO_RC_MODE);
    cugo_wait(100);
  }else if(cugo_runmode == CUGO_CMD_MODE){//自動走行モード
    //ここから自動走行モードの記述  


    //ここまで自動走行モードの記述
    
    ld2_set_control_mode(CUGO_RC_MODE); 
    cugo_wait(1000);
    //自動走行モードを1回のloopで終了する場合のみ記載、不要の場合コメントアウト
    
  }
}

プログラムモードでシーケンシャルに命令を設定している場合、プログラムを最初から実行したい場合があります。 このとき、cugo_switching_reset = true;にすると、プログラムを毎回最初から実行させることができます（cugo_beginner_programmingと同じ動作）。デフォルトはfalseです。

cugo_switching_reset = false; の時

cugo_switching_reset = true; の時

ウォッチドッグタイマを使用してプログラムをリセットしているため、再起動に3秒ほどかかります。 ラジコンモード⇔プログラムモードの切り替えを素早く行うとプログラムモードが開始されないように感じることがあります。 （ラジコンモードに切り替えてから、短い時間でプログラムモードに切り替えた時が対象）
このとき、確実にラジコンモードに切り替えた後、約3秒間待ってから、プログラムモードに切り替える操作（スティックを右に倒す）をしてください。

なお、ラジコン操作は下位システムが常に制御をしているため、RaspberryPiPicoが再起動している間も操作をすることができますので、ご安心ください。

• 正方形に移動させたい場合は下記コードを参考にしてください

void loop() {

  //プロポ入力によりcugo_run_modeが変化
  if(cugo_runmode == CUGO_RC_MODE){//ラジコンモード
    ld2_set_control_mode(CUGO_RC_MODE);
    cugo_wait(100);
  }else if(cugo_runmode == CUGO_CMD_MODE){//自動走行モード
    //ここから自動走行モードの記述  
      //サンプルコード記載
                
        Serial.println(F("自動走行モード開始"));  
        cugo_wait(1000);
        
        Serial.println(F("1.0mの正方形移動の実施"));
        cugo_move_forward(1.0);
        cugo_wait(1000);
        cugo_turn_clockwise(90);
        cugo_wait(1000);
        cugo_move_forward(1.0);
        cugo_wait(1000);
        cugo_turn_clockwise(90);
        cugo_wait(1000);
        cugo_move_forward(1.0);
        cugo_wait(1000);
        cugo_turn_clockwise(90);
        cugo_wait(1000);
        cugo_move_forward(1.0);
        cugo_wait(1000);
        cugo_turn_clockwise(90);
        cugo_wait(1000);
        
        Serial.println(F("自動走行モード終了"));
        
      //サンプルコード終了

    //ここまで自動走行モードの記述
    
    ld2_set_control_mode(CUGO_RC_MODE); 
    cugo_wait(1000);
    //自動走行モードを1回のloopで終了する場合のみ記載、不要の場合コメントアウト
    
  }
}

• S字に移動させたい場合は下記コードを参考にしてください

void loop() {

  //プロポ入力によりcugo_run_modeが変化
  if(cugo_runmode == CUGO_RC_MODE){//ラジコンモード
    ld2_set_control_mode(CUGO_RC_MODE);
    cugo_wait(100);
  }else if(cugo_runmode == CUGO_CMD_MODE){//自動走行モード
    //ここから自動走行モードの記述  
    Serial.println(F("自動走行モード開始"));  
    cugo_wait(1000);

    Serial.println(F("半径1.0mのS字移動"));
    cugo_curve_theta_raw(1.0,180,90);
    cugo_wait(1000);  
    cugo_curve_theta_raw(-1.0,180,90);
    cugo_wait(1000);  

    Serial.println(F("自動走行モード終了")); 

    //ここまで自動走行モードの記述
    
    ld2_set_control_mode(CUGO_RC_MODE); 
    cugo_wait(1000);
    //自動走行モードを1回のloopで終了する場合のみ記載、不要の場合コメントアウト
    
  }
}

• その他、関数の使い方の例はCugoSDK.cpp内のcugo_testを参考にしてください。

• 【説明】
  • CuGoが前進後進する関数です。
  • cugo_move_forward_rawは位置制御を実施していないため、上限速度まで急峻に到達し、目標距離を超えると急停止します。
• 【構文】
  • cugo_move_forward(float target_distance)
  • cugo_move_forward(float target_distance,float target_rpm)
  • cugo_move_forward_raw(float target_distance,float target_rpm)
• 【パラメータ】
  • target_distance ：目標距離　単位はm
  • target_rpm ：上限速度　単位はrpm
• 【戻り値】
  • なし

• 【説明】
  • CuGoが時計回りに回転する関数です。
  • cugo_turn_clockwise_rawは位置制御を実施していないため、上限速度まで急峻に到達し、目標距離を超えると急停止します。
• 【構文】
  • cugo_turn_clockwise(float target_degree)
  • cugo_turn_clockwise(float target_degree,float target_rpm)
  • cugo_turn_clockwise_raw(float target_degree,float target_rpm)
• 【パラメータ】
  • target_degree ：目標距離　単位は度
  • target_rpm ：上限速度　単位はrpm
• 【戻り値】
  • なし

• 【説明】
  • CuGoが反時計回りに回転する関数です。
  • cugo_turn_counterclockwise_rawは位置制御を実施していないため、上限速度まで急峻に到達し、目標距離を超えると急停止します。
• 【構文】
  • cugo_turn_counterclockwise(float target_degree)
  • cugo_turn_counterclockwise(float target_degree,float target_rpm)
  • cugo_turn_counterclockwise_raw(float target_degree,float target_rpm)
• 【パラメータ】
  • target_degree ：目標距離　単位は度
  • target_rpm ：上限速度　単位はrpm
• 【戻り値】
  • なし

• 【説明】
  • CuGoが指定した半径を指定した角度まで円軌道する関数です。
  • cugo_turn_counterclockwise_rawは位置制御を実施していないため、上限速度まで急峻に到達し、目標距離を超えると急停止します。
• 【構文】
  • cugo_curve_theta_raw(float target_radius,float target_degree,float target_rpm)
• 【パラメータ】
  • target_radius ：円軌道半径　単位はm
    • 円軌道半径は指定した値が正の場合、原点はcugoの進行方向左側になります
  • target_degree ：円軌道角度　単位は度
  • target_rpm ：上限速度　単位はrpm
• 【戻り値】
  • なし

• 【説明】
  • CuGoが指定した半径を指定した移動距離まで円軌道する関数です。
  • cugo_turn_counterclockwise_rawは位置制御を実施していないため、上限速度まで急峻に到達し、目標距離を超えると急停止します。
• 【構文】
  • cugo_curve_distance_raw(float target_radius,float target_disttance,float target_rpm)
• 【パラメータ】
  • target_radius ：円軌道半径　単位はm
    • 円軌道半径は指定した値が正の場合、原点はCuGoの進行方向左側になります
  • target_disttance ：円軌道距離　単位はm
  • target_rpm ：上限速度　単位はrpm
• 【戻り値】
  • なし

• 【説明】
  • CuGoが停止する関数です。
• 【構文】
  • cugo_stop()
• 【パラメータ】
  • なし
• 【戻り値】
  • なし

• 【説明】

  • CugoSDKSampleでは割り込み処理を利用してモード遷移をしているため、delay関数を使用しないことを強く推奨します。
  • cugo_waitはdelay関数と同等の役割を果たす関数になります。
  • cugo_waitはCugoSDKSample内で利用する停止関数です。
  • cugo_waitの計測時間の上限は約70分です。７０分以上の計測にはcugo_long_waitを利用してください。
  • PICO内の水晶子を利用しているため時間は正確でない場合があります。

• 【構文】

  • cugo_wait(unsigned long long int wait_ms)
  • cugo_long_wait(unsigned long long int wait_seconds)

• 【パラメータ】

  • wait_ms ：停止時間　単位はミリ秒
  • wait_sedonds ：停止時間　単位は秒

• 【戻り値】

  • なし

• 【説明】
  • CuGoのオドメトリを取得します。
• 【構文】
  • cugo_check_odometer(int check_number)
• 【パラメータ】
  • check_number :以下から選択
  • CUGO_ODO_X , CUGO_ODO_Y , CUGO_ODO_THETA, CUGO_ODO_DEGREE
  • 上記の定数はdefineによりそれぞれ0,1,2,3の数値に対応しています。
• 【戻り値】
  • float型

• 【説明】
  • CuGoを利用するための初期設定関数です。setup関数内にあります。
• 【構文】
  • cugo_init

• 【説明】
  • モーターへプロポ入力します。
  • モーターを停止させたい場合は左右のパラメータに0を入力します。
• 【構文】
  • cugo_rpm_direct_instructions(float left, float right)
• 【パラメータ】
  • left 左モーターへの入力値(RPM)
  • right 右モーターへの入力値(RPM)
• 【戻り値】
  • なし