coverage
Toggle main menu visibility
読み取り中…
検索中…
一致する文字列を見つけられません
zone_field.py
[詳解]
1
"""清掃ゾーンの点列をROSメッセージに依存せず検証・正規化する。
2
3
入力点列は ``/cleaning_zone`` のPolygonStamped由来であり、正規化後は
4
NavigateCompleteCoverageゴールへ渡す。ROSメッセージの組み立てはbridgeが担当する。
5
"""
6
7
from
__future__
import
annotations
8
9
import
math
10
from
dataclasses
import
dataclass
11
from
typing
import
Sequence
12
13
Point2D = tuple[float, float]
14
15
16
@dataclass(frozen=True)
17
class
NormalizedZone
:
18
"""frame_idと検証済み頂点列を保持する不変値。
19
20
閉路表現で末尾に始点が重複していても、``points`` には始点を一度だけ保持する。
21
"""
22
23
frame_id: str
24
points: tuple[Point2D, ...]
25
26
@classmethod
27
def
from_points
(
28
cls,
29
frame_id: str,
30
points: Sequence[Sequence[float]],
31
min_vertices: int = 3,
32
) ->
'NormalizedZone'
:
33
"""座標列を検証し、閉路終端を除いた不変ゾーンを生成する。"""
34
return
cls(frame_id=frame_id, points=tuple(
35
normalize_zone
(points, min_vertices=min_vertices)
36
))
37
38
39
def
normalize_zone
(
40
points: Sequence[Sequence[float]],
41
min_vertices: int = 3,
42
) -> list[Point2D]:
43
"""清掃ゾーンの頂点列を数値座標へ変換して検証する。
44
45
閉路表現の末尾重複点は除去する。頂点数不足、数値変換不能、または
46
非有限なx/y座標がある場合はValueErrorを送出する。頂点順序は維持する。
47
48
Args:
49
points: 各要素がx/yを持つ頂点列。座標単位は[m]。
50
min_vertices: 正規化後に必要な最小頂点数。
51
52
Returns:
53
入力順を保った正規化済みのx/y座標列。
54
"""
55
try
:
56
pts = [(float(p[0]), float(p[1]))
for
p
in
points]
57
except
(IndexError, TypeError, ValueError)
as
exc:
58
raise
ValueError(
'zone points must contain numeric x/y coordinates'
)
from
exc
59
if
len(pts) >= 2
and
pts[0] == pts[-1]:
60
pts = pts[:-1]
61
if
len(pts) < min_vertices:
62
raise
ValueError(
63
f
'zone must have at least {min_vertices} vertices, got {len(pts)}'
64
)
65
for
x, y
in
pts:
66
if
not
(math.isfinite(x)
and
math.isfinite(y)):
67
raise
ValueError(f
'zone contains non-finite coordinate: {(x, y)}'
)
68
return
pts
coverage.zone_field.NormalizedZone
frame_idと検証済み頂点列を保持する不変値。
定義
zone_field.py:17
coverage.zone_field.NormalizedZone.from_points
'NormalizedZone' from_points(cls, str frame_id, Sequence[Sequence[float]] points, int min_vertices=3)
座標列を検証し、閉路終端を除いた不変ゾーンを生成する。
定義
zone_field.py:32
coverage.zone_field.normalize_zone
list[Point2D] normalize_zone(Sequence[Sequence[float]] points, int min_vertices=3)
清掃ゾーンの頂点列を数値座標へ変換して検証する。
定義
zone_field.py:42
coverage
zone_field.py
構築:
1.18.0