Beispiel #1
0
  /**
   * handle the crossroads...
   *
   * @param wayList
   */
  private void handleCrossRoads(List<Way> wayList) {
    int z = 0;
    List<Way> splittedWay = new ArrayList<Way>();

    for (Waypoint waypoint : allWaypoints.values()) {
      if (waypoint.getAddedWays().size() > 1) {
        for (Way way : waypoint.getAddedWays()) {
          if (way.getStart() == waypoint || way.getEnd() == waypoint) {
            z++;
          } else {
            way.addSplitPoint(waypoint);
            if (!splittedWay.contains(way)) {
              splittedWay.add(way);
            }
          }
        }
      }
    }

    for (Way way : splittedWay) {

      effectiveWayList.remove(way);

      int start = 0;
      int end = 0;
      long generatedKey = 0;

      List<Waypoint> splitWaypointList =
          sortWaypoints(way.getWaypointList(), way.getSplitPointList());

      for (Waypoint waypoint : splitWaypointList) {
        end = way.getWaypointList().indexOf(waypoint);

        if (end < start) {
          int temp = end;
          end = start;
          start = temp;
        }

        List<Waypoint> newWaypoints = getWaypointSubset(start, end, way.getWaypointList());

        Way newWay = new Way();
        newWay.setStatus(WayStatusEnum.undefined);

        generatedKey = way.getWayID() + 1;

        while (allWays.containsKey(generatedKey)) {
          generatedKey++;
        }

        newWay.setWayID(generatedKey);
        newWay.setName(way.getWayID() + "Part" + start + "-" + end);
        Waypoint startPoint = newWaypoints.get(0);
        Waypoint endPoint = waypoint;

        newWay.setStart(startPoint);
        newWay.setEnd(endPoint);
        newWay.setWaypointList(newWaypoints);
        effectiveWayList.add(newWay);
        allWays.put(newWay.getWayID(), newWay);

        start = end;
      }

      if (end != way.getWaypointList().size() - 1) {
        end = way.getWaypointList().size() - 1;
        List<Waypoint> newWaypoints = getWaypointSubset(start, end, way.getWaypointList());
        Way newWay = new Way();
        newWay.setStatus(WayStatusEnum.undefined);
        newWay.setName(way.getWayID() + "Part" + start + "-" + end);

        while (allWays.containsKey(generatedKey)) {
          generatedKey++;
        }

        newWay.setWayID(generatedKey);
        start = 0;
        end = newWaypoints.size() - 1;
        Waypoint startPoint = newWaypoints.get(start);
        Waypoint endPoint = newWaypoints.get(end);

        newWay.setStart(startPoint);
        newWay.setEnd(endPoint);
        newWay.setWaypointList(newWaypoints);
        effectiveWayList.add(newWay);
        allWays.put(newWay.getWayID(), newWay);
      }
    }
  }
Beispiel #2
0
  private Map<Long, Waypoint> getAllWaypointFromDocument(byte[] array) {

    allWaypoints = new HashMap<Long, Waypoint>();

    VTDGen vg = new VTDGen();
    vg.setDoc(array);
    try {
      vg.parse(false);
    } catch (EncodingException e) {
      logger.fatal(e);
    } catch (EOFException e) {
      logger.fatal(e);
      throw new RuntimeException(e);
    } catch (EntityException e) {
      logger.fatal(e);
      throw new RuntimeException(e);
    } catch (ParseException e) {
      logger.fatal(e);
      throw new RuntimeException(e);
    }

    VTDNav vn = vg.getNav();

    AutoPilot ap = new AutoPilot(vn);

    ap.selectElement("node");

    try {
      while (ap.iterate()) {

        int latPos = vn.getAttrVal("lat");
        int lonPos = vn.getAttrVal("lon");
        int idPos = vn.getAttrVal("id");

        double lat = Double.parseDouble(vn.toString(latPos));

        double lon = Double.parseDouble(vn.toString(lonPos));

        long id = Long.parseLong(vn.toString(idPos));

        Waypoint waypoint = new Waypoint();

        waypoint.setWaypointID(id);

        // set latitude and longitude for waypoint
        waypoint.setLat(lat);
        waypoint.setLon(lon);

        // set position (lon and lat in one value)
        Angle latAngle = Angle.fromDegreesLatitude(lat);
        Angle lonAngle = Angle.fromDegreesLatitude(lon);
        Position pos = new Position(latAngle, lonAngle, 0);
        waypoint.setCenter(pos);

        allWaypoints.put(id, waypoint);
      }
    } catch (PilotException e) {
      logger.fatal(e);
      throw new RuntimeException(e);
    } catch (NavException e) {
      logger.fatal(e);
      throw new RuntimeException(e);
    }

    return allWaypoints;
  }