名称 MIRS2605 ソフトウェア詳細設計
番号 MIRS2605-SOFT-0001

版数 最終更新日 作成 承認 改訂記事 A01 2026.10.27 第1版

ソフトウェア詳細設計

本書は、草刈り範囲を指定日時に自律走行するソフトウェアの設計を定める。

機能概要

機能 概要
清掃条件設定 利用者が決定した草刈り範囲と日時に対して保存と処理を行う
自己位置推定 事前に保存した地図と現在の生成中の地図を比較し、現在位置を推定する
経路設計 範囲内の走行経路を生成する
自律走行 生成された経路を自己位置推定をしながら走行を行う
安全性 超音波センサ、LiDARの生データを使い、急な障害物にも対応する

ロボットの動作設計(全体フロー)

起動、予約受付、自己位置推定、制御権切替、安全監視、自律清掃、結果記録のフローチャート
フローチャート

接続方式

ROS 2ノード・トピック構成図

各トピックを独立した矢印で示すROS 2ノード・トピック構成図
ノード・トピック構成図

ROS2 TFツリー構成図

各フレームをTFを図で示す

モジュール構成

各ソフトウェアの構成要素を以下に示す。再現性に重点をおいて、開発環境を選定した。

開発環境

マイコン/計算機 接続先デバイス 通信・信号方式 方向・用途 設定・補足
車載コンピュータ 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への配置は今後の作業とする。シミュレータは実機開発を補助する位置づけとし、走行安全性やセンサの実測性能は現地の実機試験で確認する。