teco-kit/PointAndControl

using System;
using System.Windows.Media.Media3D;

namespace PointAndControl.Helperclasses
{
    static class  IgsMath
    {

        public static Double l2Norm(Vector3D vector)
        {
            return norm(vector, 2.0);
        }

        private static Double norm(Vector3D vector, double p)
        {
            Double result = 0;
            double diffX = Math.Abs(vector.X);
            double diffY = Math.Abs(vector.Y);
            double diffZ = Math.Abs(vector.Z);

            if (p == 2.0)
            {
                result = Math.Sqrt(Math.Pow(diffX, p) + Math.Pow(diffY, p) + Math.Pow(diffZ, p));
            }
            else
            {
                Double pow = 1.0 / p;
                result = Math.Pow((Math.Pow(diffX, p) + Math.Pow(diffY, p) + Math.Pow(diffZ, p)), pow);
            }
            return result;
        }
    }
}