public static Point2D FindTargetPosition(this Garics robot, ScannedRobotEvent e)
{
var angle = robot.HeadingRadians + e.BearingRadians;
//TODO this takes a lot of negatives. Find out what's going on.
return(new Point2D(robot.PositionVector - Vector2DHelpers.VectorFromAngle(-angle - Math.PI / 2, e.Distance)));
}
public static Vector2D RightVector(this EnemyData data, double length = 1)
{
return(data.Position.PointToVector() + Vector2DHelpers.VectorFromAngle(-data.HeadingRadians) * length);
}