Esempio n. 1
0
        public override bool IsIntersect(Ray ray, Matrices transform)
        {
            //if (a == 0)
            //{
            //    ray.IntersectDistance = -c / b;
            //    return true;
            //}
            //else if (D < 0)
            //    return false;
            //else
            //{

            Vector L = ray.Position - this.center;
            double a = Vector.DotProduct(ray.Direction, ray.Direction);
            double b = 2 * Vector.DotProduct(ray.Direction, L);
            double c = Vector.DotProduct(L, L) - this.radius * this.radius;

            double D = b * b - 4 * a * c;
            double q = (b > 0) ?
                -0.5 * (b + Math.Sqrt(D)) : -0.5 * (b - Math.Sqrt(D));
            double[] t = new double[2];
            t[0] = q / a;
            t[1] = c/q;
            //if (t[0] > 0 && t[1] > 0)
            //{
            Vector temp1 = ray.Direction * Math.Min(t[0], t[1]);
            Matrices temp2 = new Matrices(temp1.x, temp1.y, temp1.z, 1);
            temp2 = transform.Matrix * temp2;
            temp1.x = temp2.Matrix[0, 0];
            temp1.y = temp2.Matrix[1, 0];
            temp1.z = temp2.Matrix[2, 0];
            ray.IntersectDistance = temp1.Distance();
            //ray.IntersectDistance = Math.Min(t[0], t[1]);
            return true;
                //}
                //else if (t[0] < 0 && t[1] > 0)
                //{
                //    ray.IntersectDistance = t[1];
                //    return true;
                //}
                //else if (t[0] > 0 && t[1] < 0)
                //{
                //    ray.IntersectDistance = t[0];
                //    return true;
                //}
                //else return false;
            //}
        }
Esempio n. 2
0
 public override bool IsIntersect(Ray ray, Matrices transform)
 {
     Vector temp = Vector.CrossProduct((this.pointC - this.pointA),(this.pointB - this.pointA));
     Vector n = temp / temp.Distance();
     double a = Vector.DotProduct(this.pointA, n);
     double b = Vector.DotProduct(ray.GetPosition(), n);
     double c = Vector.DotProduct(ray.GetDirection(), n);
     double t = (a - b) / c;
     Vector pointT = ray.GetPosition() + (ray.GetDirection() * t);
     if (PointInTriangle(pointT))
     {
         Vector temp1 = ray.Direction * t;
         Matrices temp2 = new Matrices(temp1.x, temp1.y, temp1.z, 1);
         temp2 = transform.Matrix * temp2;
         temp1.x = temp2.Matrix[0, 0];
         temp1.y = temp2.Matrix[1, 0];
         temp1.z = temp2.Matrix[2, 0];
         ray.IntersectDistance = temp1.Distance() ;
         //ray.IntersectDistance = t ;
         //ray.IntersectWith = this;
         return true;
     }
     else return false;
 }
Esempio n. 3
0
        private void AutoTest(object sender, DoWorkEventArgs e)
        {
            object[] param = (object[])e.Argument;
            int avg_cnt = (int)param[0];
            int KNN_K = (int)param[1];
            int KNNHC_K = (int)param[2];
            string db_file_name = (string)param[3];
            string data_file_name = (string)param[4];
            double start_snr = (double)param[5];
            double stop_snr = (double)param[6];
            double step_snr = (double)param[7];
            int ray_num = (int)param[8];
            Transmitter.EMIT_OPTION emit_opt = (Transmitter.EMIT_OPTION)param[9];
            Noise_Type noise_type = (Noise_Type)param[10];
            double alpha = (double)param[11];
            int sample_cnt = (int)param[12];
            Signal_Type signal_type = (Signal_Type)param[13];

            System.IO.FileStream data_fs = new FileStream(data_file_name, FileMode.Create, FileAccess.Write, FileShare.Read);

            System.Runtime.Serialization.IFormatter formatter = new System.Runtime.Serialization.Formatters.Binary.BinaryFormatter();
            FileStream fs = new FileStream(db_file_name, FileMode.Open, FileAccess.Read, FileShare.Read);
            FingerprintDataBase fdb = (FingerprintDataBase)formatter.Deserialize(fs);
            fs.Close();

            Point pt_real = new Point();
            foreach (Transmitter trans in this.viz_rps.Map.Transmitters)
                pt_real = trans.Location;

            double[] snrs = new double[(int)((stop_snr - start_snr) / step_snr) + 1];
            for(int i = 0; i < snrs.Length; i++)
                snrs[i] = start_snr + i * step_snr;

            foreach (Transmitter trans in this.viz_rps.Map.Transmitters)
            {
                trans.Reset();
                trans.EmitRays(ray_num, emit_opt);   //各发射机辐射波束
                foreach (Receiver rec in this.viz_rps.Map.Receivers)
                {
                    rec.Reset();
                    if (this.viz_rps.Map.IsLOS(trans.Location, rec.Location))    //若存在LOS情况
                    {
                        LineSegment segLOS = new LineSegment(trans.Location, rec.Location);
                        Ray rayLOS = new Ray(trans, new LineSegment[] { segLOS }, segLOS.DirectionRadian, trans.CenterFrequency, trans.EmitPower * trans.Gain, trans.EmitPower * trans.Gain, true);
                        rec.AcceptRay(rayLOS, this.viz_rps.Map);
                    }
                }
                foreach (Ray ray in trans.Rays)  //更新每条ray, 若被接收,则更新接收它的接收机
                {
                    Receiver rec = null;
                    while (!ray.Update(this.viz_rps.Map, out rec)) ;
                    if (rec != null)
                        rec.AcceptRay(ray, this.viz_rps.Map);
                }
            }
            FingerprintGenerator fg = new FingerprintGenerator();
            Dictionary<Fingerprint_Name, Fingerprint> result = new Dictionary<Fingerprint_Name, Fingerprint>();
            List<double>[] ray_angles = new List<double>[this.viz_rps.Map.ReceiverCount];
            List<double>[] ray_strengths = new List<double>[this.viz_rps.Map.ReceiverCount];
            List<double>[] ray_taus = new List<double>[this.viz_rps.Map.ReceiverCount];
            int kk = 0;
            foreach (Receiver rec in this.viz_rps.Map.Receivers)
            {
                ray_angles[kk] = new List<double>();
                ray_strengths[kk] = new List<double>();
                ray_taus[kk] = new List<double>();
                foreach (Ray ray in rec.Rays)
                {
                    ray_angles[kk].Add(ray.CurrentDirection);
                    ray_strengths[kk].Add(ray.FadedPower(this.viz_rps.Map.MeterPixelRatio));
                    ray_taus[kk].Add(ray.GetLifeSpan(this.viz_rps.Map.MeterPixelRatio));
                }
                kk++;
            }
            double[] args = null;
            switch (signal_type)
            {
                case Signal_Type.PSEUDO_DOPPLER:
                    //if (this.receivers.First().Value.Antenna.AntType != AntennaType.PSEUDO_DOPPLER)
                    //    return null;
                    Antenna_PseudoDoppler ant = this.viz_rps.Map.receivers.First().Value.Antenna as Antenna_PseudoDoppler;
                    args = fg.PackArgs_PseudoDoppler(this.viz_rps.Map.receivers.First().Value.FrequencyLow, this.viz_rps.Map.receivers.First().Value.CenterFrequency,
                                                     this.viz_rps.Map.receivers.First().Value.SampleFrequency, ant.SwitchFrequency, ant.Radius, ant.AntennaNumber);
                    break;
            }
            MWNumericArray[] signals = new MWNumericArray[ray_angles.GetLength(0)];
            for (int i = 0; i < signals.Length; i++)
            {
                signals[i] = new FingerprintGenerator().GenerateSignal_MW(signal_type, ray_angles[i].ToArray(), ray_strengths[i].ToArray(), ray_taus[i].ToArray(), sample_cnt, args);                
            }

            for (int n = 0; n < snrs.Length; n++)
            {
                double[] sum_errs = new double[6];//SA_single, SA_KNN, SA_KNNHC, S_single, S_KNN, S_KNNHC
                for(int i = 0; i < avg_cnt; i++)
                {
                    MWNumericArray[] n_signals = new MWNumericArray[signals.Length];
                    for (int l = 0; l < signals.Length; l++)
                    {
                        n_signals[l] = new FingerprintGenerator().AddNoise_MW(noise_type, signals[l], new double[] { snrs[n] });
                    }
                    Dictionary<Fingerprint_Name, Fingerprint> res = new Dictionary<Fingerprint_Name,Fingerprint>();
                    for (int j = 0; j < Enum.GetNames(new Fingerprint_Name().GetType()).Length; j++ )
                        res[(Fingerprint_Name)j] = new FingerprintGenerator().GenerateFingerprint(signal_type, (Fingerprint_Name)j, n_signals, args);
                    this.current_fingerprint = res;

                    //SA_single
                    PointF loc_SA_single = fdb.MatchLocation(this.current_fingerprint[Fingerprint_Name.SA], FingerprintDataBase.Match_Strategy.Single, null);
                    sum_errs[0] += new MathUtils.MathUtility().point_dist(pt_real, loc_SA_single);

                    //SA_KNN
                    PointF loc_SA_KNN = fdb.MatchLocation(this.current_fingerprint[Fingerprint_Name.SA], FingerprintDataBase.Match_Strategy.KNN, new double[] { KNN_K });
                    sum_errs[1] += new MathUtils.MathUtility().point_dist(pt_real, loc_SA_KNN);

                    //SA_KNNHC
                    PointF loc_SA_KNNHC = fdb.MatchLocation(this.current_fingerprint[Fingerprint_Name.SA], FingerprintDataBase.Match_Strategy.KNN_HC, new double[] { KNNHC_K });
                    sum_errs[2] += new MathUtils.MathUtility().point_dist(pt_real, loc_SA_KNNHC);

                    //S_single
                    PointF loc_S_single = fdb.MatchLocation(this.current_fingerprint[Fingerprint_Name.S], FingerprintDataBase.Match_Strategy.Single, null);
                    sum_errs[3] += new MathUtils.MathUtility().point_dist(pt_real, loc_S_single);

                    //S_KNN
                    PointF loc_S_KNN = fdb.MatchLocation(this.current_fingerprint[Fingerprint_Name.S], FingerprintDataBase.Match_Strategy.KNN, new double[] { KNN_K });
                    sum_errs[4] += new MathUtils.MathUtility().point_dist(pt_real, loc_S_KNN);

                    //S_KNNHC
                    PointF loc_S_KNNHC = fdb.MatchLocation(this.current_fingerprint[Fingerprint_Name.S], FingerprintDataBase.Match_Strategy.KNN_HC, new double[] { KNNHC_K });
                    sum_errs[5] += new MathUtils.MathUtility().point_dist(pt_real, loc_S_KNNHC);

                    bgAutoTest.ReportProgress((int)((n * avg_cnt + i + 1) / (double)(avg_cnt * snrs.Length) * 100));
                    System.Threading.Thread.Sleep(200);
                }

                for (int m = 0; m < sum_errs.Length; m++ )
                {
                    double err = sum_errs[m] / avg_cnt;
                    byte[] tmp = Encoding.ASCII.GetBytes(err.ToString("0.00") + "\t");
                    data_fs.Write(tmp, 0, tmp.Length);
                }
                byte[] rn = Encoding.ASCII.GetBytes("\r\n");
                data_fs.Write(rn, 0, rn.Length);
            }

            data_fs.Close();
            e.Result = true;
        }
Esempio n. 4
0
 private MWNumericArray[][] wrap_func(int num, int ray_num, Transmitter.EMIT_OPTION emit_opt, Signal_Type signal_type, int sample_cnt)
 {
     MWNumericArray[][] signals = new MWNumericArray[num][];
     while (num-- > 0)
     {
         foreach (Transmitter trans in this.viz_rps.Map.Transmitters)
         {
             trans.Reset();
             trans.EmitRays(ray_num, emit_opt);   //各发射机辐射波束
             foreach (Receiver rec in this.viz_rps.Map.Receivers)
             {
                 rec.Reset();
                 if (this.viz_rps.Map.IsLOS(trans.Location, rec.Location))    //若存在LOS情况
                 {
                     LineSegment segLOS = new LineSegment(trans.Location, rec.Location);
                     Ray rayLOS = new Ray(trans, new LineSegment[] { segLOS }, segLOS.DirectionRadian, trans.CenterFrequency, trans.EmitPower * trans.Gain, trans.EmitPower * trans.Gain, true);
                     rec.AcceptRay(rayLOS, this.viz_rps.Map);
                 }
             }
             foreach (Ray ray in trans.Rays)  //更新每条ray, 若被接收,则更新接收它的接收机
             {
                 Receiver rec = null;
                 while (!ray.Update(this.viz_rps.Map, out rec)) ;
                 if (rec != null)
                     rec.AcceptRay(ray, this.viz_rps.Map);
             }
         }
         FingerprintGenerator fg = new FingerprintGenerator();
         Dictionary<Fingerprint_Name, Fingerprint> result = new Dictionary<Fingerprint_Name, Fingerprint>();
         List<double>[] ray_angles = new List<double>[this.viz_rps.Map.ReceiverCount];
         List<double>[] ray_strengths = new List<double>[this.viz_rps.Map.ReceiverCount];
         List<double>[] ray_taus = new List<double>[this.viz_rps.Map.ReceiverCount];
         int kk = 0;
         foreach (Receiver rec in this.viz_rps.Map.Receivers)
         {
             ray_angles[kk] = new List<double>();
             ray_strengths[kk] = new List<double>();
             ray_taus[kk] = new List<double>();
             foreach (Ray ray in rec.Rays)
             {
                 ray_angles[kk].Add(ray.CurrentDirection);
                 ray_strengths[kk].Add(ray.FadedPower(this.viz_rps.Map.MeterPixelRatio));
                 ray_taus[kk].Add(ray.GetLifeSpan(this.viz_rps.Map.MeterPixelRatio));
             }
             kk++;
         }
         double[] args = null;
         switch (signal_type)
         {
             case Signal_Type.PSEUDO_DOPPLER:
                 //if (this.receivers.First().Value.Antenna.AntType != AntennaType.PSEUDO_DOPPLER)
                 //    return null;
                 Antenna_PseudoDoppler ant = this.viz_rps.Map.receivers.First().Value.Antenna as Antenna_PseudoDoppler;
                 args = fg.PackArgs_PseudoDoppler(this.viz_rps.Map.receivers.First().Value.FrequencyLow, this.viz_rps.Map.receivers.First().Value.CenterFrequency,
                                                  this.viz_rps.Map.receivers.First().Value.SampleFrequency, ant.SwitchFrequency, ant.Radius, ant.AntennaNumber);
                 break;
         }
         signals[num - 1] = new MWNumericArray[ray_angles.GetLength(0)];
         for (int i = 0; i < signals.Length; i++)
         {
             signals[num - 1][i] = new FingerprintGenerator().GenerateSignal_MW(signal_type, ray_angles[i].ToArray(), ray_strengths[i].ToArray(), ray_taus[i].ToArray(), sample_cnt, args);
         }
     }
     return signals;
 }
Esempio n. 5
0
 /// <summary>
 /// 接收一个波束,并更新接收机参数,只有与接收频率相同的波束才会产生影响
 /// </summary>
 /// <param name="ray"></param>
 public void AcceptRay(Ray ray, Map map)
 {
     if(ray.CenterFrequency == this.CenterFrequency)
     {
         this.rays.Add(ray);
         this.total_power += ray.FadedPower(map.MeterPixelRatio) * this.Gain;
     }
 }
Esempio n. 6
0
        public static Ray Intersection(Ray ray, Scene scene)
        {
            double mindist = double.MaxValue;
            foreach(Object obj in scene.ObjectList)
            {
                //for (int i = 0; i < obj.Transform.Matrix.GetLength(0); i++)
                //{
                //    for (int j = 0; j < obj.Transform.Matrix.GetLength(1); j++)
                //        Console.Write("\t" + obj.Transform.Matrix[i, j]);
                //    Console.WriteLine();
                //}
                //
                //Console.WriteLine();
                //
                //for(int i = 0 ; i < obj.Transform.Invers.GetLength(0) ; i++)
                //{
                //    for(int j = 0 ; j < obj.Transform.Invers.GetLength(1) ; j++)
                //        Console.Write("\t" + obj.Transform.Invers[i,j]);
                //    Console.WriteLine();
                //}
                //Console.WriteLine();
                //Console.WriteLine("---------------------------------");
                //Console.WriteLine();
                //Console.ReadKey();

                Matrices pos = new Matrices(ray.Position.x, ray.Position.y, ray.Position.z, 1);

                //Console.WriteLine(pos.Matrix[0, 0] + " " + pos.Matrix[1, 0] + " " + pos.Matrix[2, 0] + " " + pos.Matrix[3, 0]);

                pos = obj.Transform.Invers * pos;

                //Console.WriteLine(pos.Matrix[0, 0] + " " + pos.Matrix[1, 0] + " " + pos.Matrix[2, 0] + " " + pos.Matrix[3, 0]);
                //Console.ReadKey();

                Matrices dir = new Matrices(ray.Direction.x, ray.Direction.y, ray.Direction.z, 0);
                dir = obj.Transform.Invers * dir;

                //Debug--------------------------------------------------
                //Console.WriteLine(ray.Position.x + " " + ray.Position.y + " " + ray.Position.z);
                //Console.WriteLine(pos.Matrix[0, 0] + " " + pos.Matrix[1, 0] + " " + pos.Matrix[2, 0]);
                //Console.ReadKey();
                //-------------------------------------------------------

                ray.Position.x = pos.Matrix[0,0];
                ray.Position.y = pos.Matrix[1,0];
                ray.Position.z = pos.Matrix[2,0];

                ray.Direction.x = dir.Matrix[0, 0];
                ray.Direction.y = dir.Matrix[1, 0];
                ray.Direction.z = dir.Matrix[2, 0];

                if (obj.IsIntersect(ray,obj.Transform) && ray.IntersectDistance < mindist)
                {
                    mindist = ray.IntersectDistance;
                    ray.IntersectWith = obj;
                }
                // kali transform biasa ray direction(1) + position(0)
                pos = obj.Transform.Matrix * pos;
                dir = obj.Transform.Matrix * dir;

                ray.Position.x = pos.Matrix[0, 0];
                ray.Position.y = pos.Matrix[1, 0];
                ray.Position.z = pos.Matrix[2, 0];

                ray.Direction.x = dir.Matrix[0, 0];
                ray.Direction.y = dir.Matrix[1, 0];
                ray.Direction.z = dir.Matrix[2, 0];
            }
            ray.IntersectDistance = mindist;
            return ray;
        }
Esempio n. 7
0
 public abstract bool IsIntersect(Ray ray, Matrices transform);
Esempio n. 8
0
File: Map.cs Progetto: Yinzhe-Qi/RPS
        /// <summary>
        /// 运行单次仿真
        /// </summary>
        public Dictionary<Fingerprint_Name, Fingerprint> RunSingleSimulation(int num_rays, Transmitter.EMIT_OPTION emit_option, Signal_Type signal_type,
                                                 Noise_Type noise_type, double[] noise_params, int N)
        {
            foreach(Transmitter trans in this.Transmitters)
            {
                trans.Reset();
                trans.EmitRays(num_rays, emit_option);   //各发射机辐射波束
                foreach(Receiver rec in this.Receivers)
                {
                    rec.Reset();
                    if(this.IsLOS(trans.Location, rec.Location))    //若存在LOS情况
                    {
                        LineSegment segLOS = new LineSegment(trans.Location, rec.Location);
                        Ray rayLOS = new Ray(trans, new LineSegment[] { segLOS }, segLOS.DirectionRadian, trans.CenterFrequency, trans.EmitPower * trans.Gain, trans.EmitPower * trans.Gain, true);
                        rec.AcceptRay(rayLOS, this);
                    }
                }
                foreach(Ray ray in trans.Rays)  //更新每条ray, 若被接收,则更新接收它的接收机
                {
                    Receiver rec = null;
                    while (!ray.Update(this, out rec)) ;
                    if (rec != null)
                        rec.AcceptRay(ray, this);
                }
            }

            FingerprintGenerator fg = new FingerprintGenerator();
            Dictionary<Fingerprint_Name, Fingerprint> result = new Dictionary<Fingerprint_Name,Fingerprint>();
            List<double>[] ray_angles = new List<double>[this.receivers.Count];
            List<double>[] ray_strengths = new List<double>[this.receivers.Count];
            List<double>[] ray_taus = new List<double>[this.receivers.Count];
            int i = 0;
            foreach(Receiver rec in this.Receivers)
            {
                ray_angles[i] = new List<double>();
                ray_strengths[i] = new List<double>();
                ray_taus[i] = new List<double>();
                foreach(Ray ray in rec.Rays)
                {
                    ray_angles[i].Add(ray.CurrentDirection);
                    ray_strengths[i].Add(ray.FadedPower(this.MeterPixelRatio));
                    ray_taus[i].Add(ray.GetLifeSpan(this.MeterPixelRatio));
                }
                i++;
            }
            double[] args = null;
            switch (signal_type)
            {
                case Signal_Type.PSEUDO_DOPPLER:
                    if (this.receivers.First().Value.Antenna.AntType != AntennaType.PSEUDO_DOPPLER)
                        return null;
                    Antenna_PseudoDoppler ant = this.receivers.First().Value.Antenna as Antenna_PseudoDoppler;
                    args = fg.PackArgs_PseudoDoppler(this.receivers.First().Value.FrequencyLow, this.receivers.First().Value.CenterFrequency,
                                                     this.receivers.First().Value.SampleFrequency, ant.SwitchFrequency, ant.Radius, ant.AntennaNumber);
                    break;
            }
            for (int j = 0; j < Enum.GetNames(new Fingerprint_Name().GetType()).Length; j++ )
                result[(Fingerprint_Name)j] = fg.SingleFingerprintSim(signal_type, noise_type, noise_params, (Fingerprint_Name)j, ray_angles, ray_strengths, ray_taus,
                                                 N, args);
            return result;
        }
Esempio n. 9
0
        public override bool Hit(Ray r, float tMin, float tMax, out HitRecord rec)
        {
            //Plane plane = Plane.CreateFromVertices(points[0], points[1], points[2]);
            var normal = Vector3.Normalize(Vector3.Cross((points[0] - points[1]), (points[1] - points[2])));

            r.direction = Vector3.Normalize(r.direction);
            rec         = new HitRecord();
            //面片背面剔除
            var cos = Vector3.Dot(r.direction, normal);

            if (cos == 0)
            {
                return(false);
            }
            if (cullBack && cos < 0)
            {
                return(false);
            }


            //计算t(距离)
            rec.t = Vector3.Dot(points[0] - r.from, normal) / Vector3.Dot(r.direction, normal);
            //rec.t = (Vector3.Dot(normal,points[0]) - Vector3.Dot(normal, r.from) )/ Vector3.Dot(normal,r.direction );

            if (float.IsNaN(rec.t) || rec.t < tMin || rec.t > tMax)
            {
                return(false);
            }

            //计算p(平面交点)
            var p = r.from + rec.t * r.direction;

            //光栅剔除
            points.Add(points[0]);
            Vector3 firstTowards = Vector3.Zero;

            for (int i = 0; i < points.Count - 1; i++)
            {
                var oa      = Vector3.Normalize(points[i] - points[i + 1]);
                var op      = Vector3.Normalize(points[i] - p);
                var towards = Vector3.Normalize(Vector3.Cross(oa, op));
                if (firstTowards == Vector3.Zero)
                {
                    firstTowards = towards;
                }
                else if (Vector3.Dot(firstTowards, towards) < 0.999999)
                {
                    points.RemoveAt(points.Count - 1);
                    return(false);
                }
            }
            points.RemoveAt(points.Count - 1);
            rec.position = p;

            //是否有normal记录
            if (normals.Count == points.Count)
            {
                if (uvs.Count == 3)
                {
                    rec.normal = GetAvgNormalInTriangle(p);
                }
                else
                {
                    rec.normal = GetAvgNormal(p);
                }
            }
            else
            {
                rec.normal = normal;
            }



            //是否有uv记录
            if (uvs.Count == points.Count)
            {
                if (uvs.Count == 3)
                {
                    rec.uv = GetAvgUVInTriangle(p);
                }
                else
                {
                    rec.uv = GetAvgUV(p);
                }
            }


            rec.material = material;


            return(true);
        }
Esempio n. 10
0
File: Ray.cs Progetto: Yinzhe-Qi/RPS
 public RayEnumerator(Ray[] ray)
 {
     this.rays = ray.Clone() as Ray[];
 }
Esempio n. 11
0
File: Ray.cs Progetto: Yinzhe-Qi/RPS
 public RayCollection(Ray[] r)
 {
     this.rays = r;
 }