public double DistanceTo(XYZBCMachPosition pos)
{
var v1 = new Vector3(_x, _y, _z);
var v2 = new Vector3(pos.X, pos.Y, pos.Z);
double d = v1.DistanceTo(v2);
return(d);
}
public XYZBCMachPosition(XYZBCMachPosition p)
{
_geometry = MachineGeometry.XYZBC;
_bRad = GeomUtilities.ToRadians(p.Bdeg);
_cRad = GeomUtilities.ToRadians(p.Cdeg);
_x = p.X;
_y = p.Y;
_z = p.Z;
}