public bool isSamePenMove(PenMove a, PenMove b)
{
return(a.up == b.up && isSameXY(a.destination, b.destination));
}
public Vector3f getPosition(PenMove pm)
{
return(new Vector3f(pm.destination.x, pm.destination.y, pm.up ? travelHeightMM : maxPenetrationDepthMM));
}
public void Add(PenMove p)
{
moves.Add(p);
}