navigableRegionList.add(statistics.getNavigableRegion(i));
public static void assertVisibilityGraphStatisticsEqual(VisibilityGraphStatistics expected, VisibilityGraphStatistics actual, double epsilon) { assertEquals(expected.getGoalMapId(), actual.getGoalMapId()); assertEquals(expected.getStartMapId(), actual.getStartMapId()); assertEquals(expected.getInterRegionsMapId(), actual.getInterRegionsMapId()); assertVisibilityMapsEqual(expected.getGoalVisibilityMap(), actual.getGoalVisibilityMap(), epsilon); assertVisibilityMapsEqual(expected.getStartVisibilityMap(), actual.getStartVisibilityMap(), epsilon); assertVisibilityMapsEqual(expected.getInterRegionsVisibilityMap(), actual.getInterRegionsVisibilityMap(), epsilon); assertEquals(expected.getNumberOfNavigableRegions(), actual.getNumberOfNavigableRegions()); for (int i = 0; i < expected.getNumberOfNavigableRegions(); i++) assertNavigableRegionsEqual(expected.getNavigableRegion(i), actual.getNavigableRegion(i), epsilon); }
statistics.getInterRegionsVisibilityMap().addConnections(incomingStatistics.getInterRegionsVisibilityMap().getConnections()); for (int i = 0; i < incomingStatistics.getNumberOfNavigableRegions(); i++) statistics.addNavigableRegion(incomingStatistics.getNavigableRegion(i));
public static BodyPathPlanStatisticsMessage convertToBodyPathPlanStatisticsMessage(int planId, VisibilityGraphStatistics statistics) { BodyPathPlanStatisticsMessage message = new BodyPathPlanStatisticsMessage(); message.setPlanId(planId); message.getGoalVisibilityMap().set(convertToVisibilityMapMessage(statistics.getGoalMapId(), statistics.getGoalVisibilityMap())); message.getStartVisibilityMap().set(convertToVisibilityMapMessage(statistics.getStartMapId(), statistics.getStartVisibilityMap())); message.getInterRegionsMap().set(convertToVisibilityMapMessage(statistics.getInterRegionsMapId(), statistics.getInterRegionsVisibilityMap())); for (int i = 0; i < statistics.getNumberOfNavigableRegions(); i++) message.getNavigableRegions().add().set(convertToNavigableRegionMessage(statistics.getNavigableRegion(i))); return message; }