package com.zy.asrs.utils;
|
|
import java.util.ArrayList;
|
import java.util.List;
|
|
public class Point {
|
public double x;
|
public double y;
|
|
public Point(double x, double y) {
|
this.x = x;
|
this.y = y;
|
}
|
|
public double distance(Point other) {
|
double dx = this.x - other.x;
|
double dy = this.y - other.y;
|
return Math.sqrt(dx*dx + dy*dy);
|
}
|
|
public double angle(Point other) {
|
double dx = other.x - this.x;
|
double dy = other.y - this.y;
|
return Math.atan2(dy, dx);
|
}
|
|
public Point interpolate(Point other, double t) {
|
double newX = this.x + t * (other.x - this.x);
|
double newY = this.y + t * (other.y - this.y);
|
return new Point(newX, newY);
|
}
|
|
public static List<Point> interpolate(Point p1, Point p2, double interval) {
|
List<Point> points = new ArrayList<>();
|
double distance = p1.distance(p2);
|
double angle = p1.angle(p2);
|
|
for (double t=interval/distance; t<1; t+=interval/distance) {
|
Point p = p1.interpolate(p2, t);
|
points.add(p);
|
}
|
|
return points;
|
}
|
}
|
