|
coverage
|
清掃ゾーンのNav2実行要求と状態通知を管理する。 [詳解]
公開メンバ関数 | |
| None | __init__ (self) |
| topic、action client、再試行タイマーを初期化する。 | |
限定公開メンバ関数 | |
| bool | _bool_param (self, str name, bool default) |
| 指定パラメータをboolとして取得する。 | |
| float | _float_param (self, str name, float default) |
| 指定パラメータをfloatとして取得する。 | |
| int | _int_param (self, str name, int default) |
| 指定パラメータをintとして取得する。 | |
| None | _sync_retry_params (self) |
| 再送上限と待機秒数 [s] をROSパラメータへ追従させる。 | |
| None | _publish_state (self, str text) |
| coverage状態文字列をstate topicへpublishする。同一文言の連続送信は抑止する。 | |
| None | _set_phase (self, str phase, str reason='') |
| 最新の処理段階を保持し、変化時に/coverage/phaseへ通知する。 | |
| None | _publish_diagnostics (self) |
| bridge内部の判定値とgoal段階を/diagnosticsへ1.0s周期で出す。 | |
| None | _on_map (self, OccupancyGrid msg) |
| 事前検証用に最新の地図を保持する。 | |
| bool | _zone_blocked_by_static_obstacles (self, NormalizedZone zone) |
| ゾーン内占有率が上限超ならTrueを返す。地図未受信時は検証しない。 | |
| None | _on_zone (self, PolygonStamped msg) |
| 受信ゾーンを検証し、Nav2へ最新の実行要求を送る。 | |
| None | _on_retry_timer (self) |
| 実行中要求がなく再試行時刻を過ぎた場合、保留ゾーンを再送する。 | |
| NavigateCompleteCoverage.Goal | _make_goal (self, NormalizedZone zone) |
| 正規化済みゾーンからCoverageNavigatorのgoalを組み立てる。 | |
| None | _cancel_current_goal (self) |
| 現在のgoalを無効化し、受理済みならNav2へcancelを要求する。 | |
| None | _try_send (self, NormalizedZone zone) |
| action serverを確認し、ゾーンgoalを非同期で送信する。 | |
| bool | _stale (self, int gen) |
| 指定世代が最新でなく、結果を破棄すべきならTrueを返す。 | |
| None | _on_feedback (self, int gen, msg) |
| 最新goalの残距離とリカバリ回数を記録する。 | |
| None | _on_goal_response (self, int gen, future) |
| goal受理結果を処理し、受理時は結果コールバックを登録する。 | |
| None | _register_setback (self, bool goal_rejected, str reason='') |
| 拒否・実行失敗を計数し、上限到達で諦めてterminal状態を通知する。 | |
| None | _on_nav_result (self, int gen, future) |
| 最新goalの終了状態をDONE、CANCELED、失敗として通知する。 | |
限定公開変数類 | |
| _zone_topic = _coerce_str(raw['zone_topic'], '/cleaning_zone') | |
| _state_topic = _coerce_str(raw['state_topic'], '/coverage/state') | |
| _action_name | |
| _default_frame = _coerce_str(raw['frame_id'], 'map') | |
| _behavior_tree = _coerce_str(raw['behavior_tree'], '') | |
| NormalizedZone|None | _pending_zone = None |
| _lock = threading.Lock() | |
| _goal_handle = None | |
| bool | _executing = False |
| int | _generation = 0 |
| _retry = RetryPolicy() | |
| str | _last_state = '' |
| str | _phase = 'IDLE' |
| str | _phase_reason = 'waiting for cleaning_zone' |
| int | _zone_vertices = 0 |
| float|None | _zone_received_at = None |
| str | _occupancy_check = 'NOT_RUN' |
| float|None | _occupied_ratio = None |
| float|None | _unknown_ratio = None |
| float|None | _occupancy_limit = None |
| str | _goal_id = '' |
| int|None | _last_nav_error_code = None |
| float|None | _feedback_received_at = None |
| float|None | _remaining_distance = None |
| int | _recoveries = 0 |
| _state_pub = self.create_publisher(String, self._state_topic, 10) | |
| _phase_pub | |
| _diagnostics_pub | |
| _on_zone | |
| OccupancyGrid|None | _latest_map = None |
| _on_map | |
| ActionClient | _nav_client |
| _on_retry_timer | |
| _publish_diagnostics | |
| _on_goal_response | |
| _on_nav_result | |
清掃ゾーンのNav2実行要求と状態通知を管理する。
/cleaning_zone の最新値を送信し、サーバ不在やゴール拒否時は再試行する。 新しいゾーンの受信時は実行中ゴールをキャンセルして最新値を優先する。
coverage_bridge.py の 71 行目に定義があります。
| None coverage.coverage_bridge.CoverageBridge.__init__ | ( | self | ) |
topic、action client、再試行タイマーを初期化する。
coverage_bridge.py の 78 行目に定義があります。
|
protected |
指定パラメータをboolとして取得する。
coverage_bridge.py の 171 行目に定義があります。
|
protected |
現在のgoalを無効化し、受理済みならNav2へcancelを要求する。
coverage_bridge.py の 392 行目に定義があります。
|
protected |
指定パラメータをfloatとして取得する。
coverage_bridge.py の 180 行目に定義があります。
|
protected |
指定パラメータをintとして取得する。
coverage_bridge.py の 184 行目に定義があります。
|
protected |
正規化済みゾーンからCoverageNavigatorのgoalを組み立てる。
coverage_bridge.py の 370 行目に定義があります。
|
protected |
最新goalの残距離とリカバリ回数を記録する。
coverage_bridge.py の 441 行目に定義があります。
|
protected |
goal受理結果を処理し、受理時は結果コールバックを登録する。
coverage_bridge.py の 456 行目に定義があります。
|
protected |
事前検証用に最新の地図を保持する。
coverage_bridge.py の 275 行目に定義があります。
|
protected |
最新goalの終了状態をDONE、CANCELED、失敗として通知する。
coverage_bridge.py の 526 行目に定義があります。
|
protected |
実行中要求がなく再試行時刻を過ぎた場合、保留ゾーンを再送する。
coverage_bridge.py の 361 行目に定義があります。
|
protected |
受信ゾーンを検証し、Nav2へ最新の実行要求を送る。
coverage_bridge.py の 315 行目に定義があります。
|
protected |
bridge内部の判定値とgoal段階を/diagnosticsへ1.0s周期で出す。
coverage_bridge.py の 215 行目に定義があります。
|
protected |
coverage状態文字列をstate topicへpublishする。同一文言の連続送信は抑止する。
coverage_bridge.py の 194 行目に定義があります。
|
protected |
拒否・実行失敗を計数し、上限到達で諦めてterminal状態を通知する。
受理時のリセットは行わない。受理後に失敗が続けば上限で諦める。
coverage_bridge.py の 481 行目に定義があります。
|
protected |
最新の処理段階を保持し、変化時に/coverage/phaseへ通知する。
coverage_bridge.py の 204 行目に定義があります。
|
protected |
指定世代が最新でなく、結果を破棄すべきならTrueを返す。
coverage_bridge.py の 436 行目に定義があります。
|
protected |
再送上限と待機秒数 [s] をROSパラメータへ追従させる。
coverage_bridge.py の 188 行目に定義があります。
|
protected |
action serverを確認し、ゾーンgoalを非同期で送信する。
server不在の確認は非ブロッキングで行い、1.0s周期タイマーが再送する。
coverage_bridge.py の 406 行目に定義があります。
|
protected |
ゾーン内占有率が上限超ならTrueを返す。地図未受信時は検証しない。
coverage_bridge.py の 280 行目に定義があります。
|
protected |
coverage_bridge.py の 99 行目に定義があります。
|
protected |
coverage_bridge.py の 102 行目に定義があります。
|
protected |
coverage_bridge.py の 101 行目に定義があります。
|
protected |
coverage_bridge.py の 138 行目に定義があります。
|
protected |
coverage_bridge.py の 107 行目に定義があります。
|
protected |
coverage_bridge.py の 125 行目に定義があります。
|
protected |
coverage_bridge.py の 109 行目に定義があります。
|
protected |
coverage_bridge.py の 106 行目に定義があります。
|
protected |
coverage_bridge.py の 123 行目に定義があります。
|
protected |
coverage_bridge.py の 124 行目に定義があります。
|
protected |
coverage_bridge.py の 114 行目に定義があります。
|
protected |
coverage_bridge.py の 151 行目に定義があります。
|
protected |
coverage_bridge.py の 105 行目に定義があります。
|
protected |
coverage_bridge.py の 155 行目に定義があります。
|
protected |
coverage_bridge.py の 119 行目に定義があります。
|
protected |
coverage_bridge.py の 122 行目に定義があります。
|
protected |
coverage_bridge.py の 120 行目に定義があります。
|
protected |
coverage_bridge.py の 434 行目に定義があります。
|
protected |
coverage_bridge.py の 153 行目に定義があります。
|
protected |
coverage_bridge.py の 479 行目に定義があります。
|
protected |
coverage_bridge.py の 159 行目に定義があります。
|
protected |
coverage_bridge.py の 142 行目に定義があります。
|
protected |
coverage_bridge.py の 104 行目に定義があります。
|
protected |
coverage_bridge.py の 115 行目に定義があります。
|
protected |
coverage_bridge.py の 136 行目に定義があります。
|
protected |
coverage_bridge.py の 116 行目に定義があります。
|
protected |
coverage_bridge.py の 162 行目に定義があります。
|
protected |
coverage_bridge.py の 127 行目に定義があります。
|
protected |
coverage_bridge.py の 126 行目に定義があります。
|
protected |
coverage_bridge.py の 111 行目に定義があります。
|
protected |
coverage_bridge.py の 130 行目に定義があります。
|
protected |
coverage_bridge.py の 98 行目に定義があります。
|
protected |
coverage_bridge.py の 121 行目に定義があります。
|
protected |
coverage_bridge.py の 118 行目に定義があります。
|
protected |
coverage_bridge.py の 97 行目に定義があります。
|
protected |
coverage_bridge.py の 117 行目に定義があります。