public RectangularBoundary(URPose lefttop, URPose righttop, URPose rightbottom, URPose leftbottom)
{
LeftTop = lefttop;
RightTop = righttop;
RightBottom = rightbottom;
LeftBottom = leftbottom;
ScanMovement = RightTop - LeftTop;
IndexMovement = LeftBottom - LeftTop;
}
public static string MoveL(URPose p, double a = 0.1, double v = 0.02)
{
return($"movel(p[{ p.Position.X }, { p.Position.Y }, { p.Position.Z }, { p.Rotation.X }, { p.Rotation.Y }, { p.Rotation.Z }], a={ a }, v={ v })\n");
}