coverage
読み取り中…
検索中…
一致する文字列を見つけられません
zone_field.py
[詳解]
1"""清掃ゾーンの点列をROSメッセージに依存せず検証・正規化する。
2
3入力点列は ``/cleaning_zone`` のPolygonStamped由来であり、正規化後は
4NavigateCompleteCoverageゴールへ渡す。ROSメッセージの組み立てはbridgeが担当する。
5"""
6
7from __future__ import annotations
8
9import math
10from dataclasses import dataclass
11from typing import Sequence
12
13Point2D = tuple[float, float]
14
15
16@dataclass(frozen=True)
18 """frame_idと検証済み頂点列を保持する不変値。
19
20 閉路表現で末尾に始点が重複していても、``points`` には始点を一度だけ保持する。
21 """
22
23 frame_id: str
24 points: tuple[Point2D, ...]
25
26 @classmethod
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
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
frame_idと検証済み頂点列を保持する不変値。
'NormalizedZone' from_points(cls, str frame_id, Sequence[Sequence[float]] points, int min_vertices=3)
座標列を検証し、閉路終端を除いた不変ゾーンを生成する。
list[Point2D] normalize_zone(Sequence[Sequence[float]] points, int min_vertices=3)
清掃ゾーンの頂点列を数値座標へ変換して検証する。