public bool Contains(Point p)
            {
                Euler   euler = new Euler();
                Point3D spt   = new Point3D();

                euler.phi     = -psi;
                euler.theta   = -theta;
                euler.psi     = -phi;
                euler.psi_a   = Euler.AXIS_Z;
                euler.theta_a = Euler.AXIS_X;
                euler.phi_a   = Euler.AXIS_Z;
                euler.transform(spt, new Point3D(p));
                Point sp = spt.toSpherePoint();

                return(FP.zero(sp.dec) && FP.ge(sp.ra, 0.0) && FP.le(sp.ra, length));
            }
            public Line(Point beg, Point end)
            {
                double l = beg.Distance(end);

                if (FP.eq(l, Math.PI))
                {
                    Debug.Assert(FP.eq(beg.ra, end.ra));
                    phi    = -Math.PI / 2;
                    theta  = Math.PI / 2;
                    psi    = beg.ra < 0.0 ? Math.PI * 2 + beg.ra : beg.ra;
                    length = Math.PI;
                    return;
                }
                if (beg.Equals(end))
                {
                    phi    = Math.PI / 2;
                    theta  = beg.dec;
                    psi    = beg.ra - Math.PI / 2;
                    length = 0.0;
                }
                else
                {
                    Point3D beg3d = new Point3D(beg);
                    Point3D end3d = new Point3D(end);
                    Point3D tp    = new Point3D();
                    Point   spt   = beg3d.cross(end3d).toSpherePoint();
                    Euler   euler = new Euler();
                    euler.phi     = -spt.ra - Math.PI / 2;
                    euler.theta   = spt.dec - Math.PI / 2;
                    euler.psi     = 0.0;
                    euler.psi_a   = Euler.AXIS_Z;
                    euler.theta_a = Euler.AXIS_X;
                    euler.phi_a   = Euler.AXIS_Z;
                    euler.transform(tp, beg3d);
                    spt = tp.toSpherePoint();

                    // invert
                    phi    = spt.ra;
                    theta  = -euler.theta;
                    psi    = -euler.phi;
                    length = l;
                }
            }
Ejemplo n.º 3
0
         public RectangleRn WrappingRectangle() { 
            Euler euler = new Euler();
            euler.phi      = phi;
            euler.theta    = theta;
            euler.psi      = psi;
            euler.psi_a    = Euler.AXIS_Z ;
            euler.theta_a  = Euler.AXIS_X;
            euler.phi_a    = Euler.AXIS_Z;
            
            if (FP.zero(length)) {
                Point3D beg3d = new Point3D();
                Point3D end3d = new Point3D();
                euler.transform(beg3d, new Point3D(0.0, 0.0));
                euler.transform(end3d, new Point3D(length, 0.0));
                RectangleRn r = beg3d.toRectangle();
                end3d.addToRectangle(r);
                return r;
            } else { 
                double l, ls, lc;
                Point3D[] v = new Point3D[4];
                Point3D tv = new Point3D();
                l  = length / 2.0; 
                ls = Math.Sin(l);
                lc = Math.Cos(l);
                euler.phi += l;
                
                v[0] = new Point3D(lc,  lc<0 ? -1.0 : -ls, 0.0);
                v[1] = new Point3D(1.0, lc<0 ? -1.0 : -ls, 0.0);
                v[2] = new Point3D(lc,  lc<0 ? +1.0 : +ls, 0.0);
                v[3] = new Point3D(1.0, lc<0 ? +1.0 : +ls, 0.0) ;
 
                Point3D min = new Point3D(1.0, 1.0, 1.0);
                Point3D max = new Point3D(-1.0, -1.0, -1.0);
 
                for (int i=0; i<4; i++) {
                    euler.transform(tv, v[i]);
                    if (tv.x < -1.0) {
                        min.x = -1.0;
                    } else if (tv.x > 1.0) {
                        max.x = 1.0;
                    } else { 
                        if (tv.x < min.x) { 
                            min.x = tv.x;
                        }
                        if (tv.x > max.x) { 
                            max.x = tv.x;
                        }
                    }
                    
                    if (tv.y < -1.0) {
                        min.y = -1.0;
                    } else if ( tv.y > 1.0 ) {
                        max.y = 1.0;
                    } else {
                        if (tv.y < min.y) { 
                            min.y = tv.y;
                        }
                        if (tv.y > max.y) { 
                            max.y = tv.y;
                        }
                    }
                    if (tv.z < -1.0) {
                        min.z = -1.0;
                    } else if (tv.z > 1.0) {
                        max.z = 1.0;
                    } else { 
                        if (tv.z < min.z) { 
                            min.z = tv.z;
                        }
                        if (tv.z > max.z) { 
                            max.z = tv.z;
                        }
                    } 
                }  
                return new RectangleRn(new double[]{min.x, min.y, min.z, max.x, max.y, max.z});
            }
        }
Ejemplo n.º 4
0
         public Line(Point beg, Point end) { 
             double l = beg.Distance(end);
             if (FP.eq(l, Math.PI)) {
                 Debug.Assert(FP.eq(beg.ra, end.ra));
                 phi = -Math.PI/2;
                 theta = Math.PI/2;
                 psi = beg.ra < 0.0 ? Math.PI*2 + beg.ra : beg.ra;
                 length = Math.PI;
                 return;
             }
             if (beg.Equals(end)) { 
                 phi    = Math.PI/2;
                 theta  = beg.dec;
                 psi    = beg.ra - Math.PI/2;
                 length = 0.0;
             } else { 
                 Point3D beg3d = new Point3D(beg);
                 Point3D end3d = new Point3D(end);
                 Point3D tp = new Point3D();
                 Point spt = beg3d.cross(end3d).toSpherePoint();
                 Euler euler = new Euler();
                 euler.phi     = - spt.ra - Math.PI/2;
                 euler.theta   =   spt.dec - Math.PI/2;
                 euler.psi     =   0.0 ;
                 euler.psi_a   = Euler.AXIS_Z;
                 euler.theta_a = Euler.AXIS_X;
                 euler.phi_a   = Euler.AXIS_Z;
                 euler.transform(tp, beg3d);
                 spt = tp.toSpherePoint();
 
                 // invert
                 phi = spt.ra;
                 theta = -euler.theta;
                 psi = -euler.phi;
                 length = l;
             }
         }
Ejemplo n.º 5
0
 public bool Contains(Point p) { 
     Euler euler = new Euler();
     Point3D spt = new Point3D();
     euler.phi     = -psi;
     euler.theta   = -theta;
     euler.psi     = -phi;
     euler.psi_a   = Euler.AXIS_Z;
     euler.theta_a = Euler.AXIS_X;
     euler.phi_a   = Euler.AXIS_Z;
     euler.transform(spt, new Point3D(p));
     Point sp = spt.toSpherePoint();
     return FP.zero(sp.dec) && FP.ge(sp.ra, 0.0) && FP.le(sp.ra, length);
 }                      
Ejemplo n.º 6
0
         public RectangleRn WrappingRectangle() { 
             Point3D[] v = new Point3D[8];
             Point3D tv = new Point3D();
             Euler euler = new Euler();
 
             double r0 = Math.Sin(rad0);
             double r1 = Math.Sin(rad1);
             double d = Math.Cos(rad1);
 
             v[0] = new Point3D(d, -r0, -r1);
             v[1] = new Point3D(d, +r0, -r1);
             v[2] = new Point3D(d, -r0, r1);
             v[3] = new Point3D(d, +r0, r1);
             v[4] = new Point3D(1.0, -r0, -r1);
             v[5] = new Point3D(1.0, +r0, -r1);
             v[6] = new Point3D(1.0, -r0, r1);
             v[7] = new Point3D(1.0, +r0, r1);
             
             euler.psi_a    = Euler.AXIS_Z ;
             euler.theta_a  = Euler.AXIS_Y;
             euler.phi_a    = Euler.AXIS_X;
             euler.phi      = phi;
             euler.theta    = theta;
             euler.psi      = psi;
 
             Point3D min = new Point3D(1.0, 1.0, 1.0);
             Point3D max = new Point3D(-1.0, -1.0, -1.0);
 
             for (int i=0; i<8; i++) {
                 euler.transform(tv, v[i]);
                 if (tv.x < -1.0) {
                     min.x = -1.0;
                 } else if (tv.x > 1.0) {
                     max.x = 1.0;
                 } else { 
                     if (tv.x < min.x) { 
                         min.x = tv.x;
                     }
                     if (tv.x > max.x) { 
                         max.x = tv.x;
                     }
                 }
       
                 if (tv.y < -1.0) {
                     min.y = -1.0;
                 } else if ( tv.y > 1.0 ) {
                     max.y = 1.0;
                 } else {
                     if (tv.y < min.y) { 
                         min.y = tv.y;
                     }
                     if (tv.y > max.y) { 
                         max.y = tv.y;
                     }
                 }
                 if (tv.z < -1.0) {
                     min.z = -1.0;
                 }  else if (tv.z > 1.0) {
                     max.z = 1.0;
                 } else { 
                     if (tv.z < min.z) { 
                         min.z = tv.z;
                     }
                     if (tv.z > max.z) { 
                         max.z = tv.z;
                     }
                 } 
             }
             return new RectangleRn(new double[]{min.x, min.y, min.z, max.x, max.y, max.z});
         }
            public RectangleRn WrappingRectangle()
            {
                Euler euler = new Euler();

                euler.phi     = phi;
                euler.theta   = theta;
                euler.psi     = psi;
                euler.psi_a   = Euler.AXIS_Z;
                euler.theta_a = Euler.AXIS_X;
                euler.phi_a   = Euler.AXIS_Z;

                if (FP.zero(length))
                {
                    Point3D beg3d = new Point3D();
                    Point3D end3d = new Point3D();
                    euler.transform(beg3d, new Point3D(0.0, 0.0));
                    euler.transform(end3d, new Point3D(length, 0.0));
                    RectangleRn r = beg3d.toRectangle();
                    end3d.addToRectangle(r);
                    return(r);
                }
                else
                {
                    double    l, ls, lc;
                    Point3D[] v  = new Point3D[4];
                    Point3D   tv = new Point3D();
                    l          = length / 2.0;
                    ls         = Math.Sin(l);
                    lc         = Math.Cos(l);
                    euler.phi += l;

                    v[0] = new Point3D(lc, lc < 0 ? -1.0 : -ls, 0.0);
                    v[1] = new Point3D(1.0, lc < 0 ? -1.0 : -ls, 0.0);
                    v[2] = new Point3D(lc, lc < 0 ? +1.0 : +ls, 0.0);
                    v[3] = new Point3D(1.0, lc < 0 ? +1.0 : +ls, 0.0);

                    Point3D min = new Point3D(1.0, 1.0, 1.0);
                    Point3D max = new Point3D(-1.0, -1.0, -1.0);

                    for (int i = 0; i < 4; i++)
                    {
                        euler.transform(tv, v[i]);
                        if (tv.x < -1.0)
                        {
                            min.x = -1.0;
                        }
                        else if (tv.x > 1.0)
                        {
                            max.x = 1.0;
                        }
                        else
                        {
                            if (tv.x < min.x)
                            {
                                min.x = tv.x;
                            }
                            if (tv.x > max.x)
                            {
                                max.x = tv.x;
                            }
                        }

                        if (tv.y < -1.0)
                        {
                            min.y = -1.0;
                        }
                        else if (tv.y > 1.0)
                        {
                            max.y = 1.0;
                        }
                        else
                        {
                            if (tv.y < min.y)
                            {
                                min.y = tv.y;
                            }
                            if (tv.y > max.y)
                            {
                                max.y = tv.y;
                            }
                        }
                        if (tv.z < -1.0)
                        {
                            min.z = -1.0;
                        }
                        else if (tv.z > 1.0)
                        {
                            max.z = 1.0;
                        }
                        else
                        {
                            if (tv.z < min.z)
                            {
                                min.z = tv.z;
                            }
                            if (tv.z > max.z)
                            {
                                max.z = tv.z;
                            }
                        }
                    }
                    return(new RectangleRn(new double[] { min.x, min.y, min.z, max.x, max.y, max.z }));
                }
            }
            public RectangleRn WrappingRectangle()
            {
                Point3D[] v     = new Point3D[8];
                Point3D   tv    = new Point3D();
                Euler     euler = new Euler();

                double r0 = Math.Sin(rad0);
                double r1 = Math.Sin(rad1);
                double d  = Math.Cos(rad1);

                v[0] = new Point3D(d, -r0, -r1);
                v[1] = new Point3D(d, +r0, -r1);
                v[2] = new Point3D(d, -r0, r1);
                v[3] = new Point3D(d, +r0, r1);
                v[4] = new Point3D(1.0, -r0, -r1);
                v[5] = new Point3D(1.0, +r0, -r1);
                v[6] = new Point3D(1.0, -r0, r1);
                v[7] = new Point3D(1.0, +r0, r1);

                euler.psi_a   = Euler.AXIS_Z;
                euler.theta_a = Euler.AXIS_Y;
                euler.phi_a   = Euler.AXIS_X;
                euler.phi     = phi;
                euler.theta   = theta;
                euler.psi     = psi;

                Point3D min = new Point3D(1.0, 1.0, 1.0);
                Point3D max = new Point3D(-1.0, -1.0, -1.0);

                for (int i = 0; i < 8; i++)
                {
                    euler.transform(tv, v[i]);
                    if (tv.x < -1.0)
                    {
                        min.x = -1.0;
                    }
                    else if (tv.x > 1.0)
                    {
                        max.x = 1.0;
                    }
                    else
                    {
                        if (tv.x < min.x)
                        {
                            min.x = tv.x;
                        }
                        if (tv.x > max.x)
                        {
                            max.x = tv.x;
                        }
                    }

                    if (tv.y < -1.0)
                    {
                        min.y = -1.0;
                    }
                    else if (tv.y > 1.0)
                    {
                        max.y = 1.0;
                    }
                    else
                    {
                        if (tv.y < min.y)
                        {
                            min.y = tv.y;
                        }
                        if (tv.y > max.y)
                        {
                            max.y = tv.y;
                        }
                    }
                    if (tv.z < -1.0)
                    {
                        min.z = -1.0;
                    }
                    else if (tv.z > 1.0)
                    {
                        max.z = 1.0;
                    }
                    else
                    {
                        if (tv.z < min.z)
                        {
                            min.z = tv.z;
                        }
                        if (tv.z > max.z)
                        {
                            max.z = tv.z;
                        }
                    }
                }
                return(new RectangleRn(new double[] { min.x, min.y, min.z, max.x, max.y, max.z }));
            }