412 lines
13 KiB
Python
412 lines
13 KiB
Python
|
from __future__ import annotations
|
||
|
|
|
||
|
|
import itertools
|
||
|
|
import math
|
||
|
|
import random
|
||
|
|
from typing import TYPE_CHECKING, Iterable, List, Set, Tuple, Union
|
||
|
|
|
||
|
|
from s2clientprotocol import common_pb2 as common_pb
|
||
|
|
|
||
|
|
if TYPE_CHECKING:
|
||
|
|
from .unit import Unit
|
||
|
|
from .units import Units
|
||
|
|
|
||
|
|
EPSILON = 10**-8
|
||
|
|
|
||
|
|
|
||
|
|
def _sign(num):
|
||
|
|
return math.copysign(1, num)
|
||
|
|
|
||
|
|
|
||
|
|
class Pointlike(tuple):
|
||
|
|
|
||
|
|
@property
|
||
|
|
def position(self) -> Pointlike:
|
||
|
|
return self
|
||
|
|
|
||
|
|
def distance_to(self, target: Union[Unit, Point2]) -> float:
|
||
|
|
"""Calculate a single distance from a point or unit to another point or unit
|
||
|
|
|
||
|
|
:param target:"""
|
||
|
|
p = target.position
|
||
|
|
return math.hypot(self[0] - p[0], self[1] - p[1])
|
||
|
|
|
||
|
|
def distance_to_point2(self, p: Union[Point2, Tuple[float, float]]) -> float:
|
||
|
|
"""Same as the function above, but should be a bit faster because of the dropped asserts
|
||
|
|
and conversion.
|
||
|
|
|
||
|
|
:param p:"""
|
||
|
|
return math.hypot(self[0] - p[0], self[1] - p[1])
|
||
|
|
|
||
|
|
def _distance_squared(self, p2: Point2) -> float:
|
||
|
|
"""Function used to not take the square root as the distances will stay proportionally the same.
|
||
|
|
This is to speed up the sorting process.
|
||
|
|
|
||
|
|
:param p2:"""
|
||
|
|
return (self[0] - p2[0])**2 + (self[1] - p2[1])**2
|
||
|
|
|
||
|
|
def sort_by_distance(self, ps: Union[Units, Iterable[Point2]]) -> List[Point2]:
|
||
|
|
"""This returns the target points sorted as list.
|
||
|
|
You should not pass a set or dict since those are not sortable.
|
||
|
|
If you want to sort your units towards a point, use 'units.sorted_by_distance_to(point)' instead.
|
||
|
|
|
||
|
|
:param ps:"""
|
||
|
|
return sorted(ps, key=lambda p: self.distance_to_point2(p.position))
|
||
|
|
|
||
|
|
def closest(self, ps: Union[Units, Iterable[Point2]]) -> Union[Unit, Point2]:
|
||
|
|
"""This function assumes the 2d distance is meant
|
||
|
|
|
||
|
|
:param ps:"""
|
||
|
|
assert ps, "ps is empty"
|
||
|
|
# pylint: disable=W0108
|
||
|
|
return min(ps, key=lambda p: self.distance_to(p))
|
||
|
|
|
||
|
|
def distance_to_closest(self, ps: Union[Units, Iterable[Point2]]) -> float:
|
||
|
|
"""This function assumes the 2d distance is meant
|
||
|
|
:param ps:"""
|
||
|
|
assert ps, "ps is empty"
|
||
|
|
closest_distance = math.inf
|
||
|
|
for p2 in ps:
|
||
|
|
p2 = p2.position
|
||
|
|
distance = self.distance_to(p2)
|
||
|
|
if distance <= closest_distance:
|
||
|
|
closest_distance = distance
|
||
|
|
return closest_distance
|
||
|
|
|
||
|
|
def furthest(self, ps: Union[Units, Iterable[Point2]]) -> Union[Unit, Pointlike]:
|
||
|
|
"""This function assumes the 2d distance is meant
|
||
|
|
|
||
|
|
:param ps: Units object, or iterable of Unit or Point2"""
|
||
|
|
assert ps, "ps is empty"
|
||
|
|
# pylint: disable=W0108
|
||
|
|
return max(ps, key=lambda p: self.distance_to(p))
|
||
|
|
|
||
|
|
def distance_to_furthest(self, ps: Union[Units, Iterable[Point2]]) -> float:
|
||
|
|
"""This function assumes the 2d distance is meant
|
||
|
|
|
||
|
|
:param ps:"""
|
||
|
|
assert ps, "ps is empty"
|
||
|
|
furthest_distance = -math.inf
|
||
|
|
for p2 in ps:
|
||
|
|
p2 = p2.position
|
||
|
|
distance = self.distance_to(p2)
|
||
|
|
if distance >= furthest_distance:
|
||
|
|
furthest_distance = distance
|
||
|
|
return furthest_distance
|
||
|
|
|
||
|
|
def offset(self, p) -> Pointlike:
|
||
|
|
"""
|
||
|
|
|
||
|
|
:param p:
|
||
|
|
"""
|
||
|
|
return self.__class__(a + b for a, b in itertools.zip_longest(self, p[:len(self)], fillvalue=0))
|
||
|
|
|
||
|
|
def unit_axes_towards(self, p):
|
||
|
|
"""
|
||
|
|
|
||
|
|
:param p:
|
||
|
|
"""
|
||
|
|
return self.__class__(_sign(b - a) for a, b in itertools.zip_longest(self, p[:len(self)], fillvalue=0))
|
||
|
|
|
||
|
|
def towards(self, p: Union[Unit, Pointlike], distance: Union[int, float] = 1, limit: bool = False) -> Pointlike:
|
||
|
|
"""
|
||
|
|
|
||
|
|
:param p:
|
||
|
|
:param distance:
|
||
|
|
:param limit:
|
||
|
|
"""
|
||
|
|
p = p.position
|
||
|
|
# assert self != p, f"self is {self}, p is {p}"
|
||
|
|
# TODO test and fix this if statement
|
||
|
|
if self == p:
|
||
|
|
return self
|
||
|
|
# end of test
|
||
|
|
d = self.distance_to(p)
|
||
|
|
if limit:
|
||
|
|
distance = min(d, distance)
|
||
|
|
return self.__class__(
|
||
|
|
a + (b - a) / d * distance for a, b in itertools.zip_longest(self, p[:len(self)], fillvalue=0)
|
||
|
|
)
|
||
|
|
|
||
|
|
def __eq__(self, other):
|
||
|
|
try:
|
||
|
|
return all(abs(a - b) <= EPSILON for a, b in itertools.zip_longest(self, other, fillvalue=0))
|
||
|
|
except TypeError:
|
||
|
|
return False
|
||
|
|
|
||
|
|
def __hash__(self):
|
||
|
|
return hash(tuple(self))
|
||
|
|
|
||
|
|
|
||
|
|
# pylint: disable=R0904
|
||
|
|
class Point2(Pointlike):
|
||
|
|
|
||
|
|
@classmethod
|
||
|
|
def from_proto(cls, data) -> Point2:
|
||
|
|
"""
|
||
|
|
:param data:
|
||
|
|
"""
|
||
|
|
return cls((data.x, data.y))
|
||
|
|
|
||
|
|
@property
|
||
|
|
def as_Point2D(self) -> common_pb.Point2D:
|
||
|
|
return common_pb.Point2D(x=self.x, y=self.y)
|
||
|
|
|
||
|
|
@property
|
||
|
|
def as_PointI(self) -> common_pb.PointI:
|
||
|
|
"""Represents points on the minimap. Values must be between 0 and 64."""
|
||
|
|
return common_pb.PointI(x=self.x, y=self.y)
|
||
|
|
|
||
|
|
@property
|
||
|
|
def rounded(self) -> Point2:
|
||
|
|
return Point2((math.floor(self[0]), math.floor(self[1])))
|
||
|
|
|
||
|
|
@property
|
||
|
|
def length(self) -> float:
|
||
|
|
""" This property exists in case Point2 is used as a vector. """
|
||
|
|
return math.hypot(self[0], self[1])
|
||
|
|
|
||
|
|
@property
|
||
|
|
def normalized(self) -> Point2:
|
||
|
|
""" This property exists in case Point2 is used as a vector. """
|
||
|
|
length = self.length
|
||
|
|
# Cannot normalize if length is zero
|
||
|
|
assert length
|
||
|
|
return self.__class__((self[0] / length, self[1] / length))
|
||
|
|
|
||
|
|
@property
|
||
|
|
def x(self) -> float:
|
||
|
|
return self[0]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def y(self) -> float:
|
||
|
|
return self[1]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def to2(self) -> Point2:
|
||
|
|
return Point2(self[:2])
|
||
|
|
|
||
|
|
@property
|
||
|
|
def to3(self) -> Point3:
|
||
|
|
return Point3((*self, 0))
|
||
|
|
|
||
|
|
def round(self, decimals: int) -> Point2:
|
||
|
|
"""Rounds each number in the tuple to the amount of given decimals."""
|
||
|
|
return Point2((round(self[0], decimals), round(self[1], decimals)))
|
||
|
|
|
||
|
|
def offset(self, p: Point2) -> Point2:
|
||
|
|
return Point2((self[0] + p[0], self[1] + p[1]))
|
||
|
|
|
||
|
|
def random_on_distance(self, distance) -> Point2:
|
||
|
|
if isinstance(distance, (tuple, list)): # interval
|
||
|
|
distance = distance[0] + random.random() * (distance[1] - distance[0])
|
||
|
|
|
||
|
|
assert distance > 0, "Distance is not greater than 0"
|
||
|
|
angle = random.random() * 2 * math.pi
|
||
|
|
|
||
|
|
dx, dy = math.cos(angle), math.sin(angle)
|
||
|
|
return Point2((self.x + dx * distance, self.y + dy * distance))
|
||
|
|
|
||
|
|
def towards_with_random_angle(
|
||
|
|
self,
|
||
|
|
p: Union[Point2, Point3],
|
||
|
|
distance: Union[int, float] = 1,
|
||
|
|
max_difference: Union[int, float] = (math.pi / 4),
|
||
|
|
) -> Point2:
|
||
|
|
tx, ty = self.to2.towards(p.to2, 1)
|
||
|
|
angle = math.atan2(ty - self.y, tx - self.x)
|
||
|
|
angle = (angle - max_difference) + max_difference * 2 * random.random()
|
||
|
|
return Point2((self.x + math.cos(angle) * distance, self.y + math.sin(angle) * distance))
|
||
|
|
|
||
|
|
def circle_intersection(self, p: Point2, r: Union[int, float]) -> Set[Point2]:
|
||
|
|
"""self is point1, p is point2, r is the radius for circles originating in both points
|
||
|
|
Used in ramp finding
|
||
|
|
|
||
|
|
:param p:
|
||
|
|
:param r:"""
|
||
|
|
assert self != p, "self is equal to p"
|
||
|
|
distanceBetweenPoints = self.distance_to(p)
|
||
|
|
assert r >= distanceBetweenPoints / 2
|
||
|
|
# remaining distance from center towards the intersection, using pythagoras
|
||
|
|
remainingDistanceFromCenter = (r**2 - (distanceBetweenPoints / 2)**2)**0.5
|
||
|
|
# center of both points
|
||
|
|
offsetToCenter = Point2(((p.x - self.x) / 2, (p.y - self.y) / 2))
|
||
|
|
center = self.offset(offsetToCenter)
|
||
|
|
|
||
|
|
# stretch offset vector in the ratio of remaining distance from center to intersection
|
||
|
|
vectorStretchFactor = remainingDistanceFromCenter / (distanceBetweenPoints / 2)
|
||
|
|
v = offsetToCenter
|
||
|
|
offsetToCenterStretched = Point2((v.x * vectorStretchFactor, v.y * vectorStretchFactor))
|
||
|
|
|
||
|
|
# rotate vector by 90° and -90°
|
||
|
|
vectorRotated1 = Point2((offsetToCenterStretched.y, -offsetToCenterStretched.x))
|
||
|
|
vectorRotated2 = Point2((-offsetToCenterStretched.y, offsetToCenterStretched.x))
|
||
|
|
intersect1 = center.offset(vectorRotated1)
|
||
|
|
intersect2 = center.offset(vectorRotated2)
|
||
|
|
return {intersect1, intersect2}
|
||
|
|
|
||
|
|
@property
|
||
|
|
def neighbors4(self) -> set:
|
||
|
|
return {
|
||
|
|
Point2((self.x - 1, self.y)),
|
||
|
|
Point2((self.x + 1, self.y)),
|
||
|
|
Point2((self.x, self.y - 1)),
|
||
|
|
Point2((self.x, self.y + 1)),
|
||
|
|
}
|
||
|
|
|
||
|
|
@property
|
||
|
|
def neighbors8(self) -> set:
|
||
|
|
return self.neighbors4 | {
|
||
|
|
Point2((self.x - 1, self.y - 1)),
|
||
|
|
Point2((self.x - 1, self.y + 1)),
|
||
|
|
Point2((self.x + 1, self.y - 1)),
|
||
|
|
Point2((self.x + 1, self.y + 1)),
|
||
|
|
}
|
||
|
|
|
||
|
|
def negative_offset(self, other: Point2) -> Point2:
|
||
|
|
return self.__class__((self[0] - other[0], self[1] - other[1]))
|
||
|
|
|
||
|
|
def __add__(self, other: Point2) -> Point2:
|
||
|
|
return self.offset(other)
|
||
|
|
|
||
|
|
def __sub__(self, other: Point2) -> Point2:
|
||
|
|
return self.negative_offset(other)
|
||
|
|
|
||
|
|
def __neg__(self) -> Point2:
|
||
|
|
return self.__class__(-a for a in self)
|
||
|
|
|
||
|
|
def __abs__(self) -> float:
|
||
|
|
return math.hypot(self.x, self.y)
|
||
|
|
|
||
|
|
def __bool__(self) -> bool:
|
||
|
|
if self.x != 0 or self.y != 0:
|
||
|
|
return True
|
||
|
|
return False
|
||
|
|
|
||
|
|
def __mul__(self, other: Union[int, float, Point2]) -> Point2:
|
||
|
|
try:
|
||
|
|
return self.__class__((self.x * other.x, self.y * other.y))
|
||
|
|
except AttributeError:
|
||
|
|
return self.__class__((self.x * other, self.y * other))
|
||
|
|
|
||
|
|
def __rmul__(self, other: Union[int, float, Point2]) -> Point2:
|
||
|
|
return self.__mul__(other)
|
||
|
|
|
||
|
|
def __truediv__(self, other: Union[int, float, Point2]) -> Point2:
|
||
|
|
if isinstance(other, self.__class__):
|
||
|
|
return self.__class__((self.x / other.x, self.y / other.y))
|
||
|
|
return self.__class__((self.x / other, self.y / other))
|
||
|
|
|
||
|
|
def is_same_as(self, other: Point2, dist=0.001) -> bool:
|
||
|
|
return self.distance_to_point2(other) <= dist
|
||
|
|
|
||
|
|
def direction_vector(self, other: Point2) -> Point2:
|
||
|
|
""" Converts a vector to a direction that can face vertically, horizontally or diagonal or be zero, e.g. (0, 0), (1, -1), (1, 0) """
|
||
|
|
return self.__class__((_sign(other.x - self.x), _sign(other.y - self.y)))
|
||
|
|
|
||
|
|
def manhattan_distance(self, other: Point2) -> float:
|
||
|
|
"""
|
||
|
|
:param other:
|
||
|
|
"""
|
||
|
|
return abs(other.x - self.x) + abs(other.y - self.y)
|
||
|
|
|
||
|
|
@staticmethod
|
||
|
|
def center(points: List[Point2]) -> Point2:
|
||
|
|
"""Returns the central point for points in list
|
||
|
|
|
||
|
|
:param points:"""
|
||
|
|
s = Point2((0, 0))
|
||
|
|
for p in points:
|
||
|
|
s += p
|
||
|
|
return s / len(points)
|
||
|
|
|
||
|
|
|
||
|
|
class Point3(Point2):
|
||
|
|
|
||
|
|
@classmethod
|
||
|
|
def from_proto(cls, data) -> Point3:
|
||
|
|
"""
|
||
|
|
:param data:
|
||
|
|
"""
|
||
|
|
return cls((data.x, data.y, data.z))
|
||
|
|
|
||
|
|
@property
|
||
|
|
def as_Point(self) -> common_pb.Point:
|
||
|
|
return common_pb.Point(x=self.x, y=self.y, z=self.z)
|
||
|
|
|
||
|
|
@property
|
||
|
|
def rounded(self) -> Point3:
|
||
|
|
return Point3((math.floor(self[0]), math.floor(self[1]), math.floor(self[2])))
|
||
|
|
|
||
|
|
@property
|
||
|
|
def z(self) -> float:
|
||
|
|
return self[2]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def to3(self) -> Point3:
|
||
|
|
return Point3(self)
|
||
|
|
|
||
|
|
def __add__(self, other: Union[Point2, Point3]) -> Point3:
|
||
|
|
if not isinstance(other, Point3) and isinstance(other, Point2):
|
||
|
|
return Point3((self.x + other.x, self.y + other.y, self.z))
|
||
|
|
return Point3((self.x + other.x, self.y + other.y, self.z + other.z))
|
||
|
|
|
||
|
|
|
||
|
|
class Size(Point2):
|
||
|
|
|
||
|
|
@property
|
||
|
|
def width(self) -> float:
|
||
|
|
return self[0]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def height(self) -> float:
|
||
|
|
return self[1]
|
||
|
|
|
||
|
|
|
||
|
|
class Rect(tuple):
|
||
|
|
|
||
|
|
@classmethod
|
||
|
|
def from_proto(cls, data):
|
||
|
|
"""
|
||
|
|
:param data:
|
||
|
|
"""
|
||
|
|
assert data.p0.x < data.p1.x and data.p0.y < data.p1.y
|
||
|
|
return cls((data.p0.x, data.p0.y, data.p1.x - data.p0.x, data.p1.y - data.p0.y))
|
||
|
|
|
||
|
|
@property
|
||
|
|
def x(self) -> float:
|
||
|
|
return self[0]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def y(self) -> float:
|
||
|
|
return self[1]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def width(self) -> float:
|
||
|
|
return self[2]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def height(self) -> float:
|
||
|
|
return self[3]
|
||
|
|
|
||
|
|
@property
|
||
|
|
def right(self) -> float:
|
||
|
|
""" Returns the x-coordinate of the rectangle of its right side. """
|
||
|
|
return self.x + self.width
|
||
|
|
|
||
|
|
@property
|
||
|
|
def top(self) -> float:
|
||
|
|
""" Returns the y-coordinate of the rectangle of its top side. """
|
||
|
|
return self.y + self.height
|
||
|
|
|
||
|
|
@property
|
||
|
|
def size(self) -> Size:
|
||
|
|
return Size((self[2], self[3]))
|
||
|
|
|
||
|
|
@property
|
||
|
|
def center(self) -> Point2:
|
||
|
|
return Point2((self.x + self.width / 2, self.y + self.height / 2))
|
||
|
|
|
||
|
|
def offset(self, p):
|
||
|
|
return self.__class__((self[0] + p[0], self[1] + p[1], self[2], self[3]))
|