public static double Length(HPoint p1, HPoint p2) { var l2 = (p1.X - p2.X) * (p1.X - p2.X) + (p1.Y - p2.Y) * (p1.Y - p2.Y); if (l2 < 0) return -Math.Sqrt(-l2); else return Math.Sqrt(l2); }