public static Pos GetPos(this CommandArguments args, int index, Pos defaultPos)
{
return new Pos
{
X = args.Get(index, defaultPos.X),
Y = args.Get(index + 1, defaultPos.Y),
Z = args.Get(index + 2, defaultPos.Z)
};
}
public static double Distance(Pos from, Pos to)
{
return Math.Sqrt(Math.Pow(from.X - to.X, 2) + Math.Pow(from.Y - to.Y, 2) + Math.Pow(from.Z - to.Z, 2));
}