public Position(Position other)
: this(other.X, other.Y)
{
}
public Pose(Position position, Angle heading)
{
this.position = position; this.heading = heading;
}
public Position AddRelative(Position delta)
{
return new Position(X + delta.X * Heading.Cos - delta.Y * Heading.Sin, Y + delta.X * Heading.Sin + delta.Y * Heading.Cos);
}