ソフトウェア詳細設計
本書は、草刈り範囲を指定日時に自律走行するソフトウェアの設計を定める。
機能概要
| 機能 | 概要 |
|---|---|
| 清掃条件設定 | 利用者が決定した草刈り範囲と日時に対して保存と処理を行う |
| 自己位置推定 | 事前に保存した地図と現在の生成中の地図を比較し、現在位置を推定する |
| 経路設計 | 範囲内の走行経路を生成する |
| 自律走行 | 生成された経路を自己位置推定をしながら走行を行う |
| 安全性 | 超音波センサ、LiDARの生データを使い、急な障害物にも対応する |
ロボットの動作設計(全体フロー)
接続方式
| マイコン/計算機 | 接続先デバイス | 通信・信号方式 | 方向・用途 | 設定・補足 |
|---|---|---|---|---|
| 車載コンピュータ | ESP32 DevKitC | USB CDC または UART(micro-ROS Serial transport) | 双方向。ROS 2 と走行制御マイコン間のデータ通信 | 物理接続は機種・ポート選定時に決定。UART の場合は ESP32 UART2 GPIO16/RX・GPIO17/TX、115200 baud、3.3 V TTL、TX/RX交差接続。Agent は車載コンピュータ上で動作。 |
| 車載コンピュータ | Arduino Uno R3 #1 | USB Serial | 双方向。サーボ角度指令および角度・角速度の状態送信 | 首振り LiDAR のサーボ制御。ボーレート等の詳細設定は資料上未確定。 |
| 車載コンピュータ | Arduino Uno R3 #2 | USB Serial | 双方向。単一 DC モータへの指令と状態・距離情報の通信 | MD10C PWM/DIR 制御。ボーレート等の詳細設定は資料上未確定。 |
| ESP32 DevKitC | BMX055 IMU | I²C | ESP32 が加速度・角速度・地磁気データを取得 | SDA GPIO18、SCL GPIO27。プルアップとバス電圧を確認。 |
| ESP32 DevKitC | 左右 AMT103-V エンコーダ | GPIO デジタル直交 A/B 信号 | 入力。左右車輪回転量の計測 | 左 A/B GPIO4/5、右 A/B GPIO13/14。PCNTでX4計数。2048 PPR、8192 count/rev。 |
| ESP32 DevKitC | 左右モータドライバ | GPIO PWM / DIR | 出力。左右モータ速度・方向の指令 | 左 DIR/PWM GPIO25/26、右 DIR/PWM GPIO32/33。信号電圧・PWM条件はドライバ仕様と適合させる。 |
| ESP32 DevKitC | RC受信機 | パルス幅デジタル入力 | 入力。左・右操作およびモード変更 | GPIO21/22/23。100 msを超える信号途絶は無効扱い。 |
| Arduino Uno R3 #1 | MG996R サーボ | PWM相当のサーボ制御パルス | 出力。RPLIDAR S1 の上下走査 | 指令70〜110度、中央90度を基準とする案。角度指令往復2秒。電源・信号端子の詳細は配線図で確定。 |
| RPLIDAR S1(車載コンピュータ接続) | 車載コンピュータ | USB(製品インターフェース) | LiDARスキャンデータを計算機へ送信 | 具体的な接続ポート・ドライバ設定は採用機器と実装設定で確定。 |
| Arduino Uno R3 #2 | 超音波センサ | トリガ/エコー等のデジタル信号 | 入力。近距離障害物の距離取得 | センサ型番・端子割当・電圧条件は未確定。超音波距離情報はESP32 DevKitCへ渡す。 |
| Arduino Uno R3 #2 | MD10C モータドライバ | PWM / DIR | 出力。単一DCモータの速度・方向指令 | 車載コンピュータからの指令はUSB Serialで受け、ArduinoからドライバへPWM/DIR出力。ESP32との制御権分担を確定し、出力を並列接続しない。 |
| 複数の車載コンピュータ(構成時) | ROS 2参加者 | DDS/RTPS over Ethernet または Wi-Fi | 双方向。ROS 2ノード間通信 | 媒体、ROS_DOMAIN_ID、RMW互換性、QoS、時刻同期を構成に合わせて設定。 |
| 環境 | 概要 |
|---|---|
| Docker / Docker Compose | 開発環境の再現性を高めるため、コンテナ環境を構築・起動する。ワークスペースと機器接続をコンテナへ渡す。 |
| ROS 2 Jazzy | ROS 2のディストリビューション。ESP32のmicro-ROSビルドもJazzyに合わせる。 |
| PlatformIO | Arduino Uno R3のファームウェアについて、ボード・フレームワーク・依存ライブラリを設定し、ビルドと書込みを行う。送信設定をファイルとして保存できる |
| pioarduino | ESP32用の開発プラットフォーム。PlatformIOとuiは同じだが、espidfのバージョンがv3に対応しており、Jazzyディストロのmicro-ROSに対応するためこちらを使う。Arduinoフレームワークからidfのapiを使用する形 |
| Flutter | スマホアプリを開発するプラットフォーム、android,ios,windowsデスクトップ,webなどのアプリケーションを単一のコードからビルドすることができる |
ROS2
mirsパッケージ
mirsパッケージは標準機で自律走行までに必要なノードとローンチファイルをまとめたパッケージである。直進や旋回のテストコードが含まれる。プログラムの多くがmirs240xとmirs2605によるものである。
| ノード | 役割 |
|---|---|
| parameter_publisher | 走行制御パラメータをESP32へ配信する。 |
| scan_safety_guard | LiDAR scanから速度指令の停止・制限を行う。 |
coverageパッケージ
bleアプリから送信されたjsonをopennav_coverageが受け取れる形式に変換
| ノード | 役割 |
|---|---|
| coverage_bridge | 清掃範囲トピックをcoverage actionへ橋渡しする。 |
| coverage_monitor | 実機のtopic・TF・実行状態を監視する。 |
ble_serverパッケージ
車載コンピュータ上でBLE受信と予約データのROS 2への橋渡しを行う。
| ノード | 役割 |
|---|---|
| BleReceiverNode | BLEサーバーからデータを受け取り、変換したデータをPublishする |
| BluezBleGattServer | BluezとD-Bus接続をし、BLE GATTサービスを公開する |
| IBleGattServer | bleサーバー用のインターフェースを提供する |
| ChunkAssembler | bleのデータが断片で送られたとしても、つなぎ合わせて1つのデータに修復する |
| BleServerManager | bleサーバー用のイベントループの管理 |
nodding_lidarパッケージ
首振り2D LiDAR用のパッケージサーボの角度とLiDARの計測結果を統合する
| ノード | 役割 |
|---|---|
| servo_tf_node | サーボ角度に基づくLiDAR姿勢TFを発行する。 |
| servo_node | 首振りサーボ角度を制御 |
| scan_to_cloud | LaserScanと角度・TF情報から点群を生成する。 |
mirs_msgsパッケージ
mirsパッケージ用のメッセージ型定義
| メッセージ | 役割 |
|---|---|
| BasicParam | 制御パラメータのROS 2型を定義する。 |
| BasicCommand | 基本指令のROS 2型を定義する。 |
simulationパッケージ
自律走行シミュレーション用のパッケージ。Gazebo Hermonicをシミュレータに使用する
| 要素 | 役割 |
|---|---|
| Gazebo・RViz構成 | 現地の環境をシミュレータで再現する |
使用するオープンソースのROS2パッケージ群
| パッケージ | ノード/要素 | 役割 |
|---|---|---|
| Fields2Cover/ | Fields2Cover library | 被覆経路を計算するライブラリ。 |
| opennav_coverage/ | opennav_coverage | 清掃経路の実行を受け持つcoverage server。 |
| opennav_coverage_navigator | Nav2 BT Navigatorへcoverage actionを追加するプラグイン。 | |
| opennav_coverage_bt | 被覆経路計算・実行用Behavior Treeノード群。 | |
| opennav_coverage_msgs | coverage action・メッセージ型を定義する。 | |
| sllidar_ros2/ | sllidar_node | SLAMTEC LiDARのscanをROS 2へ配信する。 |
| glim/ | GLIM | 首振り2D LiDARの自己位置推定 |
| ground_segmentation/ | ground segmentation library | 点群から地面を分割する。 |
| ground_segmentation_ros2/ | ROS 2 integration | 地面分割ライブラリをROS 2に接続する。 |
| nav2_ground_consistency_costmap_plugin/ | Nav2 costmap plugin | 地面整合性を使うcostmap拡張。 |
| micro-ROS-Agent/ | micro_ros_agent | ESP32上のmicro-ROSとROS 2を接続する。 |
| navigation2 | Nav2 navigation stack | ROS 2ナビゲーション本体。 |
| nav2_bringup | bringup launch | Nav2一式の起動構成。 |
| nav2_common | launch support | Nav2の共通launch・設定機能。 |
| nav2_amcl | amcl | 地図上での自己位置推定。 |
| nav2_map_server | map_server | 地図をROS 2へ提供する。 |
| nav2_controller | controller_server | 経路追従用の速度指令を生成する。 |
| nav2_planner | planner_server | 目標地点までの経路を計画する。 |
| nav2_bt_navigator | bt_navigator | Behavior Treeでナビゲーション動作を管理する。 |
| nav2_lifecycle_manager | lifecycle_manager | Nav2ノード群の状態遷移を管理する。 |
| nav2_costmap_2d | global/local costmap | 障害物・走行可能領域のコストマップを生成する。 |
| dwb_core | DWB controller plugin | Nav2の局所経路追従プラグイン。 |
| dwb_msgs | ROS 2 message definitions | DWB関連メッセージ型。 |
| slam_toolbox | async_slam_toolbox_node | 2D SLAM・地図生成。 |
| robot_localization | ekf_node | センサ・オドメトリ情報をEKFで統合する。 |
| rtabmap_slam | rtabmap | RTAB-Map SLAM。 |
| rtabmap_odom | icp_odometry | 点群からオドメトリを推定する。 |
| rtabmap_viz | rtabmap_viz | RTAB-Mapの可視化・操作。 |
| rtabmap_util | point_cloud_assembler | 首振りスキャンを時間窓で統合して点群を組み立てる。 |
| foxglove_bridge | foxglove_bridge | Foxglove Studio向けにROS 2データを配信する。 |
| rviz2 | rviz2 | 地図・センサ・経路を可視化する。 |
| tf2_ros | static_transform_publisher | 固定TFを発行する。 |
| ros_gz_sim | gz_sim.launch.py / create | Gazeboシミュレータ起動とロボットモデル生成。 |
| ros_gz_bridge | parameter_bridge | GazeboとROS 2間でセンサ・走行データを中継する。 |
| xacro | xacro command | Xacro形式のロボットモデルをURDFへ展開する。 |
| robot_state_publisher | robot_state_publisher | URDFとjoint stateからロボットのTFを発行する。 |
| micro_ros_msgs | micro-ROS messages | micro-ROS Agentとの通信で使うメッセージ定義。 |
ESP32 プログラム
esp32のプログラム作成にはrtosやマルチコア、内臓のパルスカウンタなどを使用する。
| 区分 | 名称 | 役割 |
|---|---|---|
| RTOSタスク | controlTask | 制御周期ごとに指令を調停して走行制御する |
| RTOSタスク | rosTask | micro-ROS通信と状態送信を実行する |
| RTOSタスク | sensorTask | IMU・電圧センサの入力を共有状態へ渡す |
| 制御クラス | RobotController | RCとROSの制御権を調停する |
| lib | RcReceiver/ | RC受信機入力を読む |
| lib | PIDCont/ | 左右輪のPID速度制御を行う |
| lib | MotorDriver/ | モータドライバへPWMと方向を出力する |
| lib | DiffMotors/ | 差動二輪の左右モータを扱う |
| lib | ImuPlugin/ | IMU入力をセンサ共有状態へ渡す |
| lib | VoltagePlugin/ | 電圧センサ値を取得する |
| lib | Encoder/ | 車輪エンコーダを読む |
| lib | OdometryCalc/ | エンコーダ差分からオドメトリを計算する |
| lib | PoseEstimator/ | 車体姿勢・位置を推定する |
| lib | Mirs2605Ekf/ | 姿勢推定用EKFを提供する |
| lib | SystemContext/ | タスク間共有状態とmailboxを保持する |
| lib | Registry/ | センサプラグインを登録・管理する |
| lib | VelocityCalc/ | 速度関連量を計算する |
| ROS 2 topic | /cmd_vel | 速度指令を受信する |
| ROS 2 topic | /params | 走行制御パラメータを受信する |
| ROS 2 topic | /reset_odometry | オドメトリリセットを要求する |
| ROS 2 topic | /imu/data_raw | IMUデータを送信する |
| ROS 2 topic | /odom | オドメトリを送信する |
| ROS 2 topic | /encoder | エンコーダカウントを送信する |
| ROS 2 topic | /vel | 左右輪速度を送信する |
| ROS 2 topic | /vlt | バッテリー電圧を送信する |
| ROS 2 topic | /rc_debug | RC入力・制御モード情報を送信する |
| ROS 2 topic | /imu/mag | 磁気センサ情報を送信する |
| 外部ライブラリ | rclc | C言語向けROS 2 executorを提供する |
| 外部ライブラリ | rmw_microros | ROS 2とmicro-ROSの通信層を提供する |
Arduino Uno R3 プログラム
| 名称 | 役割 |
|---|---|
| micon/servo_angle/ | サーボ首振り角を更新し、角度・角速度をシリアル出力する |
| micon/md10c_uno/ | シリアルコマンドを読み、PWM/DIRでMD10Cを制御する |
| micon/ultrasonic_sensor | 超音波距離を取得して上位制御へ渡す |
スマートフォンアプリ
| 区分 | 名称 | 役割 |
|---|---|---|
| BLE制御 | BleHomeController | BLEホーム画面の接続状態を扱う |
| BLE制御 | SendMissionTracker | 予約・ミッション送信の状態を追跡する |
| BLEサービス | BleService | アプリからBLE通信機能を提供する |
| BLE接続 | BleConnection | 接続・切断状態を管理する |
| BLEプロトコル | BleProtocol | 送受信フレームを組み立て・解釈する |
| BLEアダプタ | FlutterBluePlusAdapter | flutter_blue_plusとアプリを接続する |
| 地図選択 | MapSelectionController | 表示・編集対象の地図を切り替える |
| 地図保存 | MapConfigRepository | 地図設定を永続化する |
| 地図画像 | MapImageStorage | 地図画像ファイルを保存・読出しする |
| 外部ライブラリ | flutter_blue_plus | BLE GATTクライアントを提供する |
| 外部ライブラリ | permission_handler | OS権限を扱う |
| 外部ライブラリ | sqflite | SQLiteデータベースを扱う |
| 外部ライブラリ | path_provider | アプリ用ファイル領域を取得する |
| 外部ライブラリ | image_picker | 画像選択機能を提供する |
画面設計
| 画面 | 入力・表示 |
|---|---|
| 清掃範囲 | 地図選択、多角形描画、頂点移動、範囲が有効か検証 |
| 予約条件 | 日時、繰り返し有無、繰り返し規則 |
| 登録確認 | 登録内容と予約登録の受理/拒否を表示 |
| 地図管理 | 地図追加、切替、削除 |
予約データ設計
| 項目 | 内容 | 設計条件 |
|---|---|---|
| reservation_id | 予約の一意識別子 | 更新・取消・重複排除に使用 |
| frame_id / polygon | 地図座標系と清掃範囲頂点 | 座標単位m、3頂点以上、閉路正規化 |
| start_at | 次回の実行日時 | |
| repeat | 繰り返し有無と規則 | |
| state | 予約状態 | 登録、待機、実行中、完了、失敗、取消を保持 |
通信仕様
BLE GATT
| 項目 | 用途 |
|---|---|
| Service UUID | ロボットサービス識別 |
| Mission Characteristic | 予約JSONの書込み |
| Response Characteristic | 登録受理または拒否の読み出し |
ROS 2インターフェース
| 名前 | 型 | 送信元 → 受信先・用途 |
|---|---|---|
| /cleaning_zone | geometry_msgs/PolygonStamped | ble_receiver_node → coverage_bridge:清掃範囲 |
| /initialpose | geometry_msgs/PoseWithCovarianceStamped | ble_receiver_node → AMCL:任意の初期位置 |
| /map | nav_msgs/OccupancyGrid | map_server → AMCL、coverage_bridge、Nav2の地図利用ノード |
| /scan | sensor_msgs/LaserScan | sllidar_node → AMCL、Nav2 costmap、scan_safety_guard、scan_to_cloud |
| /servo_state | sensor_msgs/JointState | serial_angle_bridge → servo_tf_node、scan_to_cloud:Arduinoからのサーボ角度 |
| /points | sensor_msgs/PointCloud2 | scan_to_cloud → RTAB-Map。シミュレータでは点群統合ノードにも入力 |
| /points_assembled | sensor_msgs/PointCloud2 | シミュレータのpoint_cloud_assembler → ground_segmentation |
| /ground_segmentation/ground_points | sensor_msgs/PointCloud2 | ground_segmentation → 可視化・監視 |
| /ground_segmentation/obstacle_points | sensor_msgs/PointCloud2 | ground_segmentation → シミュレータのNav2 costmap |
| /ground_segmentation/raw_points | sensor_msgs/PointCloud2 | ground_segmentation → 可視化・監視 |
| /encoder | std_msgs/Int32MultiArray | ESP32 DevKitC → ROS 2外部購読先:左右エンコーダcount |
| /odom | nav_msgs/Odometry | ESP32 DevKitC → robot_localization、Nav2 |
| /imu/data_raw | sensor_msgs/Imu | ESP32 DevKitC → robot_l内臓のパルスカウンタなどを使用する。そのたocalization。シミュレータではground_segmentationにも入力 |
| /imu/mag | sensor_msgs/MagneticField | ESP32 DevKitC → ROS 2外部購読先(IMU接続時) |
| /vel | std_msgs/Float64MultiArray | ESP32 DevKitC → ROS 2外部購読先:左右輪速度 |
| /vlt | std_msgs/Float64MultiArray | ESP32 DevKitC → ROS 2外部購読先:電圧テレメトリ |
| /rc_debug | std_msgs/Float64MultiArray | ESP32 DevKitC → ROS 2外部購読先:RC・制御状態 |
| /params | mirs_msgs/BasicParam | parameter_publisher → ESP32 DevKitC |
| /reset_odometry | std_msgs/Empty | ROS 2 → ESP32 DevKitC:購読実装あり。リポジトリ内にpublisherは見当たらない |
| /odometry/local | nav_msgs/Odometry | robot_localization → RTAB-Map。Nav2には主にTFで姿勢を提供 |
| /tf | tf2_msgs/TFMessage | AMCLまたはRTAB-Map → map→odom 、EKF → odom→base_link |
| /tf_static | tf2_msgs/TFMessage | static_transform_publisher等 → 固定センサ・車体座標変換 |
| /navigate_complete_coverage | opennav_coverage_msgs/NavigateCompleteCoverage action | coverage_bridge → Nav2 bt_navigator |
| /compute_coverage_path | opennav_coverage_msgs/ComputeCoveragePath action | Nav2 coverage navigator → coverage_server |
| /cmd_vel | geometry_msgs/Twist | controller_server → velocity_smoother、およびscan_safety_guard → ESP32 DevKitC |
| /cmd_vel_smoothed | geometry_msgs/Twist | velocity_smoother → collision_monitor |
| /cmd_vel_nav | geometry_msgs/Twist | collision_monitor → scan_safety_guard |
| /coverage/state | std_msgs/String | coverage_bridge → ROS 2外部購読先:実行結果 |
| /coverage/phase | std_msgs/String | coverage_bridge → ROS 2外部購読先:処理段階 |
| /diagnostics | diagnostic_msgs/DiagnosticArray | coverage_bridge、coverage_monitor → ROS 2外部購読先 |
補足:シミュレータ
Gazebo Harmonicでロボットの車体、車輪、首振り式2D LiDARなどを再現し、 ros_gz_bridge でセンサ情報と走行指令をROS 2へ接続する。RVizやFoxgloveで地図、点群、自己位置、経路を確認する。既存の simulation/ には、2D・3Dの地図作成、Nav2による走行、coverageによる清掃経路の検証に使う起動構成と簡易worldがある。
現地で取得した点群データを位置合わせ・ノイズ除去・メッシュ化し、建物や障害物の形状をGazeboの環境モデルとして配置する。表示用メッシュと衝突判定用の簡略化した形状を用意し、首振りLiDARの計測、自己位置推定、清掃範囲の経路生成、障害物を避ける走行をシミュレータ上で動作確認する。現地に行く前に経路や設定の問題を見つけ、現地での調整回数を減らすことを目的とする。
現時点のworldは簡易形状で構成されており、現地点群からのメッシュ生成とworldへの配置は今後の作業とする。シミュレータは実機開発を補助する位置づけとし、走行安全性やセンサの実測性能は現地の実機試験で確認する。