アーカイブ / Robotics
一部の距離センサーからロボット全身の回避点を決める方法
Generating Whole-Body Avoidance Motion through Localized Proximity Sensing
Generating Whole-Body Avoidance Motion through Localized Proximity Sensingの原論文から掲載した図です。細部はクリックして拡大できます。
原論文の図の説明を読む
Fig. 1: 3D model of a robotic manipulator partially covered with multi-zone proximity sensors. On the left side of the picture is highlighted an obstacle detected by one of the sensors. Despite being closer to the second, non-sensorized link of the robot, a traditional approach would use the position of the closest proximity sensor as control point to drive the obstacle avoidance behaviour. Our solution exploits knowledge of the robot’s geometry to define a dynamic avoidance task that acts on an arbitrary point over the robot’s surface, regardless of its sensorization.
概要
- 複数区画のToF距離計測とロボットの形状モデルから、障害物とロボット表面の最近接点を求める。
- センサーのないリンク上にも回避の制御点を置き、手先の目標動作は回避を妨げない範囲で行う。
- 模擬作業の点群間最小距離の平均は、左側で比較方式0.169 m・提案方式0.295 m、右側で0.281 m・0.279 mだった。
補足：編集した模式図で仕組みを確認する
VISUAL EXPLAINER
図でつかむ、Generating Whole-Body Avoidance Motion through Localized Proximity Sensingの仕組み
- 01複数区画の距離計測
- 02自身の計測値を除去
- 03全身の最近接点を探索
- 04関節速度を指令
原論文の説明をもとにした模式図です。処理の細部は省略しています。
研究の背景
この方法は、一部のリンクに置いた近接センサーで障害物を検出し、センサーのない部位も含めてロボットを遠ざける。人が近くで動く作業では、工具の先端だけでなく腕の途中や根元側も障害物に接近しうる。
センサーの取り付け位置だけを回避の基準にすると、別のリンクがもっと近い場合を直接扱えない。全身をセンサーで覆うには配置の手間もかかるため、著者らは部分的な計測とロボットの形状情報を組み合わせた。
手法
ToFは光が往復する時間から距離を測る方式で、各区画の計測値を点群、つまり位置を持つ点の集まりに変える。関節姿勢に応じたロボットの形状モデルと計測方向を照合し、自分の腕に当たる点を除く。さらに机など固定物の点を空間上の範囲で除き、近くの障害物を表す点を残す。
各リンクの表面と障害物の点群から最も近い一組の点を求め、最も距離が短いリンクの表面点を回避の基準にする。例えば人がセンサーのない根元側に近づけば、そのリンク上の点が基準になりうる。二段階の制御では距離を広げる動作を優先し、手先を目標へ動かす仕事は回避を妨げない範囲で行い、関節速度指令を計算する。
新規性
著者らの提案は、障害物を検出したセンサーの取り付け位置ではなく、ロボット表面と障害物との最近接点を回避の制御点にすることだ。最近接点は、センサーを付けていないリンク上にも設定できる。
ロボット自身を写した計測値の除去と、形状モデルを使った最近接点の探索を組み合わせ、部分的な距離計測を全身の回避動作に結び付けた。著者らは、部分的な近接センサー配置による全身回避を研究の貢献としている。
従来手法との違い
比較方式は、近接センサーの取り付け位置を制御点として障害物から遠ざける。別のリンクが障害物により近くても、その表面上の点を直接の回避点にはしない。
提案方式は同じ近接計測にロボットの形状モデルを組み合わせ、障害物との最近接点を各リンクから探す。著者らは静止した平面障害物と人が動く模擬作業で両方式を比較したが、条件ごとの結果には差がある。
実験結果
著者らは、6自由度のUR10eの一部に複数区画のToFセンサーを装着して評価した。静止した平面をロボットの前方または側方に置く試験では、センサー取り付け位置を制御点とする方式より、提案方式が点群間の最小距離を大きく保ったと報告している。
人が工具箱と車のドア模型の間を動く試験は、方式と左右の接近方向を組み合わせた4条件で各10回、各回約1分だった。点群間の最小距離の平均は、右側で比較方式0.281 m・提案方式0.279 m、左側で0.169 m・0.295 m。右側の平均値は提案方式がわずかに小さく、全条件で改善したとはいえない。
応用の可能性
編集上の応用案 · 論文が実証した用途とは区別しています。
編集上の応用案：作業者が工具箱から部品を取る組立セルで、腕の一部の近接センサーから、センサーのない根元側のリンクも含めた回避指令を計算する。入力は距離計測、センサー位置、関節姿勢、ロボットの形状モデル、目標位置で、出力は関節速度指令とする。
方法の説明に学習用データや教師ラベルは示されていない。適用時には対象機の形状モデルとセンサー配置を登録し、固定物を除く範囲と作業者の動線を現場に合わせて設定する。接近方向ごとの効果は別途検証する。
導入時の検証
導入時の検証案 · 対象データでの再評価が必要です。
導入時の検証案：対象ロボットの形状モデル、関節姿勢、センサー位置と距離計測を用意し、自分の腕に当たる計測値を除けるか確認する。方法に学習用データや教師ラベルは示されていないが、検証用には作業者や障害物の位置、接近時刻を記録する。
同じ動線を、センサー位置を制御点にする方式と提案方式で繰り返す。点群間の最小距離とその時間変化、目標動作の達成状況を左右の接近方向ごとに比べる。形状モデルと固定物を除く設定を現場に合わせ、計測が欠ける場合も調べる。
限界と課題
著者らの実験は、静止した平面と、作業者が工具箱と車のドア模型の間を動く模擬作業を対象とする。ねじ締めの実作業は行っていない。報告された距離はロボットと環境を表す点群間の値であり、これだけで接触の有無は判断できない。
編集上の検証事項は、センサーから見えない方向、計測欠落、形状モデルのずれ、制御の遅れである。また本文は作業者の位置によらず提案方式の平均最小距離が大きいと述べるが、表の右側条件は提案方式0.279 m、比較方式0.281 mで、記述と一致しない。
出典
元のタイトル・要旨を確認する（英語）
Generating Whole-Body Avoidance Motion through Localized Proximity Sensing
This paper presents a novel control algorithm for robotic manipulators in unstructured environments using proximity sensors partially distributed on the platform. The proposed approach exploits arrays of multi zone Time-of-Flight (ToF) sensors to generate a sparse point cloud representation of the robot surroundings. By employing computational geometry techniques, we fuse the knowledge of robot geometric model with ToFs sensory feedback to generate whole-body motion tasks, allowing to move both sensorized and non-sensorized links in response to unpredictable events such as human motion. In particular, the proposed algorithm computes the pair of closest points between the environment cloud and the robot links, generating a dynamic avoidance motion that is implemented as the highest priority task in a two-level hierarchical architecture. Such a design choice allows the robot to work safely alongside humans even without a complete sensorization over the whole surface. Experimental validation demonstrates the algorithm effectiveness both in static and dynamic scenarios, achieving comparable performances with respect to well established control techniques that aim to move the sensors mounting positions on the robot body. The presented algorithm exploits any arbitrary point on the robot surface to perform avoidance motion, showing improvements in the distance margin up to 100 mm, due to the rendering of virtual avoidance tasks on non-sensorized links.
論文本体の取得範囲に基づく解説。AIが作成した未校閲の記事です。性能の数値は著者の評価条件に依存します。応用例と検証計画は編集上の提案です。解説更新：2026-10-01