ble_app
読み取り中…
検索中…
一致する文字列を見つけられません
lib/models/cleaning_zone.dart

清掃する領域の頂点列を保持し、送信データとして扱う。

/// 2次元座標モデル (メートル単位)
class MapPoint {
  final double x;
  final double y;

  const MapPoint({required this.x, required this.y});

  Map<String, double> toJson() => {'x': x, 'y': y};

  factory MapPoint.fromJson(Map<String, dynamic> json) {
    final x = json['x'];
    final y = json['y'];
    if (x is! num || y is! num) {
      throw const FormatException('MapPoint requires numeric x and y values');
    }
    return MapPoint(x: x.toDouble(), y: y.toDouble());
  }

  @override
  bool operator ==(Object other) =>
      other is MapPoint && other.x == x && other.y == y;

  @override
  int get hashCode => Object.hash(x, y);

  @override
  String toString() => 'MapPoint(x: $x, y: $y)';
}

/// 清掃範囲ミッション定義モデル
class CleaningZoneMission {
  static const double maxCoordinateAbs = 1000.0;
  static const double minArea = 0.0001;
  static const int minPoints = 3;

  final String type;
  final String frameId;
  final List<MapPoint> polygon;

  const CleaningZoneMission({
    this.type = 'cleaning_zone',
    this.frameId = 'map',
    required this.polygon,
  });

  /// ROS 2 ノードが期待する JSON Map にシリアライズ
  ///
  /// 有線形式は閉路(末尾が始点と一致)とする。受信側は開路・閉路の
  /// どちらも受け付けるが、Fields2Cover規約に合わせて閉路で送る。
  Map<String, dynamic> toJson() {
    final closed = List<MapPoint>.of(polygon);
    if (closed.isNotEmpty && closed.first != closed.last) {
      closed.add(closed.first);
    }
    return {
      'type': type,
      'frame_id': frameId,
      'polygon': closed.map((p) => p.toJson()).toList(),
    };
  }

  /// 任意ポリゴンとしての清掃範囲を検証する。
  ///
  /// 閉路表現(末尾のみ始点と一致)は許容し、除去して検証する。
  /// それ以外の重複点は不正とする。
  bool get isValid {
    final pts = List<MapPoint>.of(polygon);
    if (pts.isNotEmpty && pts.first == pts.last) {
      pts.removeLast();
    }
    if (!(type.isNotEmpty &&
        frameId.isNotEmpty &&
        pts.length >= minPoints &&
        pts.every(
          (p) =>
              p.x.isFinite &&
              p.y.isFinite &&
              p.x.abs() <= maxCoordinateAbs &&
              p.y.abs() <= maxCoordinateAbs,
        ))) {
      return false;
    }

    for (var i = 0; i < pts.length; i++) {
      for (var j = i + 1; j < pts.length; j++) {
        if (pts[i] == pts[j]) return false;
      }
    }

    if (_signedAreaOf(pts).abs() < minArea) return false;

    for (var i = 0; i < pts.length; i++) {
      final a = pts[i];
      final b = pts[(i + 1) % pts.length];
      for (var j = i + 1; j < pts.length; j++) {
        if (j == i || (j == (i + 1) % pts.length)) continue;
        if (i == 0 && j == pts.length - 1) continue;
        final c = pts[j];
        final d = pts[(j + 1) % pts.length];
        if (_segmentsIntersect(a, b, c, d)) return false;
      }
    }
    return true;
  }

  static double _signedAreaOf(List<MapPoint> pts) {
    var area = 0.0;
    for (var i = 0; i < pts.length; i++) {
      final current = pts[i];
      final next = pts[(i + 1) % pts.length];
      area += current.x * next.y - next.x * current.y;
    }
    return area / 2;
  }

  bool _segmentsIntersect(MapPoint a, MapPoint b, MapPoint c, MapPoint d) {
    double cross(MapPoint p, MapPoint q, MapPoint r) =>
        (q.x - p.x) * (r.y - p.y) - (q.y - p.y) * (r.x - p.x);
    final abC = cross(a, b, c);
    final abD = cross(a, b, d);
    final cdA = cross(c, d, a);
    final cdB = cross(c, d, b);
    return (abC > 0 && abD < 0 || abC < 0 && abD > 0) &&
        (cdA > 0 && cdB < 0 || cdA < 0 && cdB > 0);
  }
}