coverage
読み取り中…
検索中…
一致する文字列を見つけられません
coverage.coverage_bridge.CoverageBridge クラス

清掃ゾーンのNav2実行要求と状態通知を管理する。 [詳解]

coverage.coverage_bridge.CoverageBridge の継承関係図

公開メンバ関数

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 行目に定義があります。

構築子と解体子

◆ __init__()

None coverage.coverage_bridge.CoverageBridge.__init__ ( self)

topic、action client、再試行タイマーを初期化する。

coverage_bridge.py の 78 行目に定義があります。

関数詳解

◆ _bool_param()

bool coverage.coverage_bridge.CoverageBridge._bool_param ( self,
str name,
bool default )
protected

指定パラメータをboolとして取得する。

coverage_bridge.py の 171 行目に定義があります。

◆ _cancel_current_goal()

None coverage.coverage_bridge.CoverageBridge._cancel_current_goal ( self)
protected

現在のgoalを無効化し、受理済みならNav2へcancelを要求する。

coverage_bridge.py の 392 行目に定義があります。

◆ _float_param()

float coverage.coverage_bridge.CoverageBridge._float_param ( self,
str name,
float default )
protected

指定パラメータをfloatとして取得する。

coverage_bridge.py の 180 行目に定義があります。

◆ _int_param()

int coverage.coverage_bridge.CoverageBridge._int_param ( self,
str name,
int default )
protected

指定パラメータをintとして取得する。

coverage_bridge.py の 184 行目に定義があります。

◆ _make_goal()

NavigateCompleteCoverage.Goal coverage.coverage_bridge.CoverageBridge._make_goal ( self,
NormalizedZone zone )
protected

正規化済みゾーンからCoverageNavigatorのgoalを組み立てる。

coverage_bridge.py の 370 行目に定義があります。

◆ _on_feedback()

None coverage.coverage_bridge.CoverageBridge._on_feedback ( self,
int gen,
msg )
protected

最新goalの残距離とリカバリ回数を記録する。

coverage_bridge.py の 441 行目に定義があります。

◆ _on_goal_response()

None coverage.coverage_bridge.CoverageBridge._on_goal_response ( self,
int gen,
future )
protected

goal受理結果を処理し、受理時は結果コールバックを登録する。

coverage_bridge.py の 456 行目に定義があります。

◆ _on_map()

None coverage.coverage_bridge.CoverageBridge._on_map ( self,
OccupancyGrid msg )
protected

事前検証用に最新の地図を保持する。

coverage_bridge.py の 275 行目に定義があります。

◆ _on_nav_result()

None coverage.coverage_bridge.CoverageBridge._on_nav_result ( self,
int gen,
future )
protected

最新goalの終了状態をDONE、CANCELED、失敗として通知する。

coverage_bridge.py の 526 行目に定義があります。

◆ _on_retry_timer()

None coverage.coverage_bridge.CoverageBridge._on_retry_timer ( self)
protected

実行中要求がなく再試行時刻を過ぎた場合、保留ゾーンを再送する。

coverage_bridge.py の 361 行目に定義があります。

◆ _on_zone()

None coverage.coverage_bridge.CoverageBridge._on_zone ( self,
PolygonStamped msg )
protected

受信ゾーンを検証し、Nav2へ最新の実行要求を送る。

coverage_bridge.py の 315 行目に定義があります。

◆ _publish_diagnostics()

None coverage.coverage_bridge.CoverageBridge._publish_diagnostics ( self)
protected

bridge内部の判定値とgoal段階を/diagnosticsへ1.0s周期で出す。

coverage_bridge.py の 215 行目に定義があります。

◆ _publish_state()

None coverage.coverage_bridge.CoverageBridge._publish_state ( self,
str text )
protected

coverage状態文字列をstate topicへpublishする。同一文言の連続送信は抑止する。

coverage_bridge.py の 194 行目に定義があります。

◆ _register_setback()

None coverage.coverage_bridge.CoverageBridge._register_setback ( self,
bool goal_rejected,
str reason = '' )
protected

拒否・実行失敗を計数し、上限到達で諦めてterminal状態を通知する。

受理時のリセットは行わない。受理後に失敗が続けば上限で諦める。

coverage_bridge.py の 481 行目に定義があります。

◆ _set_phase()

None coverage.coverage_bridge.CoverageBridge._set_phase ( self,
str phase,
str reason = '' )
protected

最新の処理段階を保持し、変化時に/coverage/phaseへ通知する。

coverage_bridge.py の 204 行目に定義があります。

◆ _stale()

bool coverage.coverage_bridge.CoverageBridge._stale ( self,
int gen )
protected

指定世代が最新でなく、結果を破棄すべきならTrueを返す。

coverage_bridge.py の 436 行目に定義があります。

◆ _sync_retry_params()

None coverage.coverage_bridge.CoverageBridge._sync_retry_params ( self)
protected

再送上限と待機秒数 [s] をROSパラメータへ追従させる。

coverage_bridge.py の 188 行目に定義があります。

◆ _try_send()

None coverage.coverage_bridge.CoverageBridge._try_send ( self,
NormalizedZone zone )
protected

action serverを確認し、ゾーンgoalを非同期で送信する。

server不在の確認は非ブロッキングで行い、1.0s周期タイマーが再送する。

coverage_bridge.py の 406 行目に定義があります。

◆ _zone_blocked_by_static_obstacles()

bool coverage.coverage_bridge.CoverageBridge._zone_blocked_by_static_obstacles ( self,
NormalizedZone zone )
protected

ゾーン内占有率が上限超ならTrueを返す。地図未受信時は検証しない。

coverage_bridge.py の 280 行目に定義があります。

メンバ詳解

◆ _action_name

coverage.coverage_bridge.CoverageBridge._action_name
protected
初期値:
= _coerce_str(
raw['action_name'], 'navigate_complete_coverage')

coverage_bridge.py の 99 行目に定義があります。

◆ _behavior_tree

coverage.coverage_bridge.CoverageBridge._behavior_tree = _coerce_str(raw['behavior_tree'], '')
protected

coverage_bridge.py の 102 行目に定義があります。

◆ _default_frame

coverage.coverage_bridge.CoverageBridge._default_frame = _coerce_str(raw['frame_id'], 'map')
protected

coverage_bridge.py の 101 行目に定義があります。

◆ _diagnostics_pub

coverage.coverage_bridge.CoverageBridge._diagnostics_pub
protected
初期値:
= self.create_publisher(
DiagnosticArray, '/diagnostics', 10)

coverage_bridge.py の 138 行目に定義があります。

◆ _executing

bool coverage.coverage_bridge.CoverageBridge._executing = False
protected

coverage_bridge.py の 107 行目に定義があります。

◆ _feedback_received_at

float | None coverage.coverage_bridge.CoverageBridge._feedback_received_at = None
protected

coverage_bridge.py の 125 行目に定義があります。

◆ _generation

int coverage.coverage_bridge.CoverageBridge._generation = 0
protected

coverage_bridge.py の 109 行目に定義があります。

◆ _goal_handle

coverage.coverage_bridge.CoverageBridge._goal_handle = None
protected

coverage_bridge.py の 106 行目に定義があります。

◆ _goal_id

str coverage.coverage_bridge.CoverageBridge._goal_id = ''
protected

coverage_bridge.py の 123 行目に定義があります。

◆ _last_nav_error_code

int | None coverage.coverage_bridge.CoverageBridge._last_nav_error_code = None
protected

coverage_bridge.py の 124 行目に定義があります。

◆ _last_state

str coverage.coverage_bridge.CoverageBridge._last_state = ''
protected

coverage_bridge.py の 114 行目に定義があります。

◆ _latest_map

OccupancyGrid | None coverage.coverage_bridge.CoverageBridge._latest_map = None
protected

coverage_bridge.py の 151 行目に定義があります。

◆ _lock

coverage.coverage_bridge.CoverageBridge._lock = threading.Lock()
protected

coverage_bridge.py の 105 行目に定義があります。

◆ _nav_client

ActionClient coverage.coverage_bridge.CoverageBridge._nav_client
protected
初期値:
= ActionClient(
self, NavigateCompleteCoverage, self._action_name
)

coverage_bridge.py の 155 行目に定義があります。

◆ _occupancy_check

str coverage.coverage_bridge.CoverageBridge._occupancy_check = 'NOT_RUN'
protected

coverage_bridge.py の 119 行目に定義があります。

◆ _occupancy_limit

float | None coverage.coverage_bridge.CoverageBridge._occupancy_limit = None
protected

coverage_bridge.py の 122 行目に定義があります。

◆ _occupied_ratio

float | None coverage.coverage_bridge.CoverageBridge._occupied_ratio = None
protected

coverage_bridge.py の 120 行目に定義があります。

◆ _on_goal_response

coverage.coverage_bridge.CoverageBridge._on_goal_response
protected

coverage_bridge.py の 434 行目に定義があります。

◆ _on_map

coverage.coverage_bridge.CoverageBridge._on_map
protected

coverage_bridge.py の 153 行目に定義があります。

◆ _on_nav_result

coverage.coverage_bridge.CoverageBridge._on_nav_result
protected

coverage_bridge.py の 479 行目に定義があります。

◆ _on_retry_timer

coverage.coverage_bridge.CoverageBridge._on_retry_timer
protected

coverage_bridge.py の 159 行目に定義があります。

◆ _on_zone

coverage.coverage_bridge.CoverageBridge._on_zone
protected

coverage_bridge.py の 142 行目に定義があります。

◆ _pending_zone

NormalizedZone | None coverage.coverage_bridge.CoverageBridge._pending_zone = None
protected

coverage_bridge.py の 104 行目に定義があります。

◆ _phase

str coverage.coverage_bridge.CoverageBridge._phase = 'IDLE'
protected

coverage_bridge.py の 115 行目に定義があります。

◆ _phase_pub

coverage.coverage_bridge.CoverageBridge._phase_pub
protected
初期値:
= self.create_publisher(
String, '/coverage/phase', phase_qos)

coverage_bridge.py の 136 行目に定義があります。

◆ _phase_reason

str coverage.coverage_bridge.CoverageBridge._phase_reason = 'waiting for cleaning_zone'
protected

coverage_bridge.py の 116 行目に定義があります。

◆ _publish_diagnostics

coverage.coverage_bridge.CoverageBridge._publish_diagnostics
protected

coverage_bridge.py の 162 行目に定義があります。

◆ _recoveries

int coverage.coverage_bridge.CoverageBridge._recoveries = 0
protected

coverage_bridge.py の 127 行目に定義があります。

◆ _remaining_distance

float | None coverage.coverage_bridge.CoverageBridge._remaining_distance = None
protected

coverage_bridge.py の 126 行目に定義があります。

◆ _retry

coverage.coverage_bridge.CoverageBridge._retry = RetryPolicy()
protected

coverage_bridge.py の 111 行目に定義があります。

◆ _state_pub

coverage.coverage_bridge.CoverageBridge._state_pub = self.create_publisher(String, self._state_topic, 10)
protected

coverage_bridge.py の 130 行目に定義があります。

◆ _state_topic

coverage.coverage_bridge.CoverageBridge._state_topic = _coerce_str(raw['state_topic'], '/coverage/state')
protected

coverage_bridge.py の 98 行目に定義があります。

◆ _unknown_ratio

float | None coverage.coverage_bridge.CoverageBridge._unknown_ratio = None
protected

coverage_bridge.py の 121 行目に定義があります。

◆ _zone_received_at

float | None coverage.coverage_bridge.CoverageBridge._zone_received_at = None
protected

coverage_bridge.py の 118 行目に定義があります。

◆ _zone_topic

coverage.coverage_bridge.CoverageBridge._zone_topic = _coerce_str(raw['zone_topic'], '/cleaning_zone')
protected

coverage_bridge.py の 97 行目に定義があります。

◆ _zone_vertices

int coverage.coverage_bridge.CoverageBridge._zone_vertices = 0
protected

coverage_bridge.py の 117 行目に定義があります。


このクラス詳解は次のファイルから抽出されました: