/// <summary>
/// Distance of two SkeletonPoints
/// </summary>
/// <param name="point1">Point 1</param>
/// <param name="point2">Point 2</param>
/// <returns>Distance of two points</returns>
private float Distance(SkeletonPoint point1, SkeletonPoint point2)
{
Vector3f vector = new Vector3f(point1.X - point2.X,
point1.Y - point2.Y, point1.Z - point2.Z);
return vector.Modulus();
}
