/** * returns true if this boxes maximum point y value <= referenceY */ public boolean isBoxAtOrBelow(double referenceY) { return (maxPoint.getY() <= referenceY); }
@Override public String toString() { String ret = ""; for (int i = 0; i < numberOfVertices; i++) { Point2d vertex = clockwiseOrderedListOfPoints.get(i); ret = ret + "{" + vertex.getX() + ", " + vertex.getY() + "}," + "\n"; } return ret; }
public void save(PrintWriter printWriter) { for (int i = 0; i < points.size(); i++) { Point2d coordinate = points.get(i); printWriter.println(coordinate.getX() + " " + coordinate.getY()); } }
public static ListOfPointsTrajectory createListOfPointsTrajectory(ArrayList<Point2d> points, ReferenceFrame referenceFrame) { ArrayList<FramePoint> framePoints = new ArrayList<FramePoint>(points.size()); for (Point2d point : points) { FramePoint framePoint = new FramePoint(referenceFrame, point.getX(), point.getY(), 0.0); framePoints.add(framePoint); } return new ListOfPointsTrajectory(framePoints); }
/** * isPointInFrontOfLine returns whether the point is in front of the line or * not. The front direction is defined as the positive x-direction * * @param point Point2d * @return boolean */ public boolean isPointInFrontOfLine(Point2d point) { return isPointInFrontOfLine(point.getX(), point.getY()); }
public void setPositionAndYaw(Point2d position, double yaw) { this.position.set(position.getX(), position.getY()); this.yaw = yaw; initialized = true; }
public void drawCross(PlotterReferenceFrame frame, Point2d center, Vector2d radii) { drawLineSegment(frame, center.getX() - radii.getX(), center.getY(), center.getX() + radii.getX(), center.getY()); drawLineSegment(frame, center.getX(), center.getY() - radii.getY(), center.getX(), center.getY() + radii.getY()); }
public void drawCircleWithCross(PlotterReferenceFrame frame, Point2d center, Vector2d radii) { drawOval(frame, center, radii); drawLineSegment(frame, center.getX() - radii.getX(), center.getY(), center.getX() + radii.getX(), center.getY()); drawLineSegment(frame, center.getX(), center.getY() - radii.getY(), center.getX(), center.getY() + radii.getY()); }
public void update(Point2d point2dUnfiltered) { x.update(point2dUnfiltered.getX()); y.update(point2dUnfiltered.getY()); }
public double getYIntercept() { double parameterAtIntercept = -point.getX() / normalizedVector.getX(); return getPointGivenParameter(parameterAtIntercept).getY(); }
public Plane3d calculatePlane(HeightMapWithPoints heightMap, Point2d center, double kernelSizeX, double kernelSizeY) throws InsufficientDataException { if ((kernelSizeX == 0) || (kernelSizeY == 0)) throw new RuntimeException("empty search region."); pointList = heightMap.getAllPointsWithinArea(center.getX(), center.getY(), kernelSizeX, kernelSizeY); Plane3d ret = new Plane3d(); planeFitter.fitPlaneToPoints(center, pointList, ret); return ret; }
@Override public void drawLegend(Plotter2DAdapter graphics, Point2d origin) { graphics.setColor(color); graphics.setFont(font); tempPoint.set(origin.getX() - 30.0, origin.getY() + 6.0); graphics.drawString(graphics.getScreenFrame(), text, tempPoint); }
public static MeshDataHolder Polygon(ConvexPolygon2d convexPolygon) { Point3f[] points = new Point3f[convexPolygon.getNumberOfVertices()]; for (int i = 0; i < convexPolygon.getNumberOfVertices(); i++) { Point2d vertex = convexPolygon.getVertex(i); points[i] = new Point3f((float) vertex.getX(), (float) vertex.getY(), 0.0f); } return Polygon(points); }
private void drawPolygon(FrameConvexPolygon2d frameConvexPolygon2d, Graphics graphics) { Polygon polygon = new Polygon(); for (int i = 0; i < frameConvexPolygon2d.getNumberOfVertices(); i++) { Point2d vertex = frameConvexPolygon2d.getVertex(i); int xInt = doubleToInt(vertex.getX(), xCenter, scale, getWidth()); int yInt = doubleToInt(vertex.getY(), yCenter, -scale, getHeight()); polygon.addPoint(xInt, yInt); } graphics.drawPolygon(polygon); }
public BlindWalkingPacket transform(Vector3d offset) { Point2d newPoint = new Point2d(desiredDestination.getX() + offset.getX(), desiredDestination.getY() + offset.getY()); return new BlindWalkingPacket(newPoint, getBlindWalkingDirection(), getBlindWalkingSpeed(), getIsInMud()); }