SimulationServer/Models/SimulationCommon/FXJHGenenrate.cs

using SimulationCommon;

namespace Model
{
    public class FXJHGenerate
    {
        public static void
            FromStartToMission(FlightPlanEditor editor, ref List<TurningPoint> turningPoints) //生成从基地到任务段起点的航路点
        {
            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "爬升",
                TurningPointLongitude = editor.originbase.BaseLongitude, //基地位置
                TurningPointLatitude = editor.originbase.BaseLatitude,
                TurningPointHeight = editor.originbase.BaseHeight,
                TurningPointType = "普通",
                //TurningPointVelocity = editor.climbsegment.ClimbVelocity;
                SegmentFlightFuelConsumption = 1,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });

            // double k;
            double lat1, lon1; //直升机起飞后爬升到的航路点的经纬度，记为经纬度1


            lat1 = (editor.originbase.BaseLatitude + editor.missionpoint.MissionPointLatitude) / 2;
            lon1 = (editor.originbase.BaseLongitude + editor.missionpoint.MissionPointLongitude) / 2;

            // k = (editor.missionpoint.MissionPointLatitude - editor.originbase.BaseLatitude) /
            //     (editor.missionpoint.MissionPointLongitude - editor.originbase.BaseLongitude);
            // if (editor.missionpoint.MissionPointLongitude > editor.originbase.BaseLongitude)
            // {
            //     lat1 = 0.08544 * k / (Math.Sqrt(k * k + 1)) + editor.originbase.BaseLatitude; //经验公式
            //     lon1 = 0.08544 / (Math.Sqrt(k * k + 1)) + editor.originbase.BaseLongitude;
            // }
            // else
            // {
            //     lat1 = editor.originbase.BaseLatitude - 0.08544 * k / (Math.Sqrt(k * k + 1));
            //     lon1 = editor.originbase.BaseLongitude - 0.08544 / (Math.Sqrt(k * k + 1));
            // }

            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "平飞",
                TurningPointLongitude = lon1,
                TurningPointLatitude = lat1,
                TurningPointHeight = 2000,
                TurningPointType = "普通",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        //获取油耗率
        public static double GetClimbFuelConsumptionRate(FlightPlanEditor editor, double height, double t)
        {
            Fuel fuel = Util.GetFuel(editor.aircraftparameter.AircraftID, editor.aircraftparameter.AircraftSubType,
                "爬升", t.ToString(), height.ToString(),
                editor.aircraftparameter.MaxTakeoffWeight.ToString());
            if (fuel == null)
            {
                return 1100;
            }

            return fuel.oilconsume;
        }

        public static double GetCruisingFuelConsumptionRate(FlightPlanEditor editor, double height, double t)
        {
            Fuel fuel = Util.GetFuel(editor.aircraftparameter.AircraftID, editor.aircraftparameter.AircraftSubType,
                "平飞远航", t.ToString(), height.ToString(),
                editor.aircraftparameter.MaxTakeoffWeight.ToString());
            if (fuel == null)
            {
                return 600;
            }

            return fuel.oilconsume;
        }

        public static double GetEnduranceFuelConsumptionRate(FlightPlanEditor editor, double height, double t)
        {
            Fuel fuel = Util.GetFuel(editor.aircraftparameter.AircraftID, editor.aircraftparameter.AircraftSubType,
                "平飞久航", t.ToString(), height.ToString(),
                editor.aircraftparameter.MaxTakeoffWeight.ToString());
            if (fuel == null)
            {
                return 600;
            }

            return fuel.oilconsume;
        }

        public static double GetDescentFuelConsumptionRate(FlightPlanEditor editor, double height, double t)
        {
            return 2 * GetCruisingFuelConsumptionRate(editor, height, t) -
                   GetClimbFuelConsumptionRate(editor, height, t);
        }

        public static double GetHoverFuelConsumptionRate(FlightPlanEditor editor, double height, double t = 0)
        {
            Fuel fuel = Util.GetFuel(editor.aircraftparameter.AircraftID, editor.aircraftparameter.AircraftSubType,
                "悬停", t.ToString(), height.ToString(),
                editor.aircraftparameter.MaxTakeoffWeight.ToString());
            if (fuel == null)
            {
                return 200;
            }

            return fuel.oilconsume;
        }


        //获取速度值

        public static double GetClimbVelocity(FlightPlanEditor editor, double height, double t)
        {
            Fuel fuel = Util.GetFuel(editor.aircraftparameter.AircraftID, editor.aircraftparameter.AircraftSubType,
                "爬升", t.ToString(), height.ToString(), editor.aircraftparameter.MaxTakeoffWeight.ToString());

            if (fuel == null)
            {
                return 60;
            }

            return fuel.speed;
        }

        public static double GetCruisingVelocity(FlightPlanEditor editor, double height, double t = 0)
        {
            Fuel fuel = Util.GetFuel(editor.aircraftparameter.AircraftID, editor.aircraftparameter.AircraftSubType,
                "平飞远航", t.ToString(), height.ToString(), editor.aircraftparameter.MaxTakeoffWeight.ToString());

            if (fuel == null)
            {
                return 200;
            }

            return fuel.speed;
        }

        public static double GetEnduranceVelocity(FlightPlanEditor editor, double height, double t)
        {
            Fuel fuel = Util.GetFuel(editor.aircraftparameter.AircraftID, editor.aircraftparameter.AircraftSubType,
                "平飞久航", t.ToString(), height.ToString(), editor.aircraftparameter.MaxTakeoffWeight.ToString());
            if (fuel == null)
            {
                return 200;
            }

            return fuel.speed;
        }

        public static double GetDescentVelocity(FlightPlanEditor editor, double height, double t)
        {
            return GetCruisingVelocity(editor, height, t) / 2;
        }

        public static void ZhenCha(List<double[]> SC01, FlightPlanEditor editor,
            ref List<TurningPoint> turningPoints) //侦查模型航路点生成
        {
            int i;
            for (i = 0; i < SC01.Count - 1; i++)
            {
                turningPoints.Add(new TurningPoint
                {
                    TurningPointName = "平飞",
                    TurningPointLongitude = SC01[i][0],
                    TurningPointLatitude = SC01[i][1],
                    TurningPointHeight = SC01[i][2],
                    TurningPointType = "侦查",
                    SegmentFlightFuelConsumption = 3,
                    SegmentFlightTime = 0,
                    RemainingFuel = 0,
                });
            }
        }

        public static void SuoHuaJiang(double resulttime, FlightPlanEditor editor,
            ref List<TurningPoint> turningPoints) //索滑降模型航路点生成
        {
            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "索滑降",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "索滑降",
                SegmentFlightFuelConsumption = 5,
                SegmentFlightTime = resulttime,
                RemainingFuel = 0,
            });

            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "索滑降",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "索滑降",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static void XunHu(FlightPlanEditor editor, ref List<TurningPoint> turningPoints)
        {
            int i;
            for (i = 0; i < editor.airroute.Length; i++)
            {
                turningPoints.Add(new TurningPoint
                {
                    TurningPointName = "平飞",
                    TurningPointLongitude = editor.airroute[i].AirRouteLongitude,
                    TurningPointLatitude = editor.airroute[i].AirRouteLatitude,
                    TurningPointHeight = 3000,
                    TurningPointType = "普通",
                    SegmentFlightFuelConsumption = 3,
                    SegmentFlightTime = 0,
                    RemainingFuel = 0,
                });
            }
        }

        public static void TongXin(FlightPlanEditor editor, ref List<TurningPoint> turningPoints)
        {
            int i;
            for (i = 0; i < editor.airroute.Length; i++)
            {
                turningPoints.Add(new TurningPoint
                {
                    TurningPointName = "平飞",
                    TurningPointLongitude = editor.airroute[i].AirRouteLongitude,
                    TurningPointLatitude = editor.airroute[i].AirRouteLatitude,
                    TurningPointHeight = editor.airroute[i].AirRouteHeight,
                    TurningPointType = "普通",
                    SegmentFlightFuelConsumption = 3,
                    SegmentFlightTime = 0,
                    RemainingFuel = 0,
                });
            }
        }

        public static void MieHuo1(FlightPlanEditor editor, ref List<TurningPoint> turningPoints) //灭火任务从取水点到火场部分的航路点生成
        {
            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "取水",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight + 60,
                TurningPointType = "取水",
                SegmentFlightFuelConsumption = 5,
                SegmentFlightTime = 60,
                RemainingFuel = 0,
            });

            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "取水",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight + 60,
                TurningPointType = "取水",
                SegmentFlightFuelConsumption = 3,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });

            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "洒水",
                TurningPointLongitude = editor.firepoint[0].FirePointLongitude,
                TurningPointLatitude = editor.firepoint[0].FirePointLatitude,
                TurningPointHeight = editor.firepoint[0].FirePointHeight + 60,
                TurningPointType = "巡航",
                SegmentFlightFuelConsumption = 5,
                SegmentFlightTime = 120,
                RemainingFuel = 0,
            });

            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "洒水",
                TurningPointLongitude = editor.firepoint[0].FirePointLongitude,
                TurningPointLatitude = editor.firepoint[0].FirePointLatitude,
                TurningPointHeight = editor.firepoint[0].FirePointHeight + 60,
                TurningPointType = "巡航",
                SegmentFlightFuelConsumption = 3,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static MissionEndPoint ZhenChaMissionEndPoint(List<double[]> SC01) //侦查模型任务终点生成
        {
            MissionEndPoint missionEndPoint = new();
            int length = SC01.Count - 1;
            missionEndPoint.MissionEndPointLongitude = SC01[length][0];
            missionEndPoint.MissionEndPointLatitude = SC01[length][1];
            missionEndPoint.MissionEndPointHeight = SC01[length][2];

            return missionEndPoint;
        }

        public static MissionEndPoint SuoHuaJiangMissionEndPoint(FlightPlanEditor editor) //索滑降模型任务终点生成
        {
            MissionEndPoint missionEndPoint = new();
            missionEndPoint.MissionEndPointLongitude = editor.missionpoint.MissionPointLongitude;
            missionEndPoint.MissionEndPointLatitude = editor.missionpoint.MissionPointLatitude;
            missionEndPoint.MissionEndPointHeight = editor.missionpoint.MissionPointHeight;

            return missionEndPoint;
        }

        public static void JijiangMiehuo1(FlightPlanEditor editor, ref List<TurningPoint> turningPoint)
        {
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 0,
                SegmentFlightTime = 600,
                RemainingFuel = 0,
            });
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static void JijiangMiehuo(FlightPlanEditor editor, ref List<TurningPoint> turningPoint)
        {
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.originbase.BaseLongitude,
                TurningPointLatitude = editor.originbase.BaseLatitude,
                TurningPointHeight = editor.originbase.BaseHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 0,
                SegmentFlightTime = 600,
                RemainingFuel = 0,
            });
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 0,
                SegmentFlightTime = 600,
                RemainingFuel = 0,
            });
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }


        public static void KouTouKouSong(FlightPlanEditor editor, ref List<TurningPoint> turningPoint)
        {
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static void KouTouKouSong1(MissionPoint missionpoint, ref List<TurningPoint> turningPoint)
        {
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = missionpoint.MissionPointLongitude,
                TurningPointLatitude = missionpoint.MissionPointLatitude,
                TurningPointHeight = missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static void JijiangJiuYuan1(FlightPlanEditor editor, ref List<TurningPoint> turningPoint)
        {
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 600,
                RemainingFuel = 0,
            });

            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static void JijiangJiuYuan(FlightPlanEditor editor, ref List<TurningPoint> turningPoint)
        {
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.originbase.BaseLongitude,
                TurningPointLatitude = editor.originbase.BaseLatitude,
                TurningPointHeight = editor.originbase.BaseHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });

            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 600,
                RemainingFuel = 0,
            });

            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = editor.missionpoint.MissionPointLongitude,
                TurningPointLatitude = editor.missionpoint.MissionPointLatitude,
                TurningPointHeight = editor.missionpoint.MissionPointHeight,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 2,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static void ZhaoShuiJiuYuan(List<AirRoute> airRoutes, ref List<TurningPoint> turningPoint)
        {
            for (int i = 0; i < airRoutes.Count; i++)
            {
                turningPoint.Add(new TurningPoint
                {
                    TurningPointName = "转运",
                    TurningPointLongitude = airRoutes[i].AirRouteLongitude,
                    TurningPointLatitude = airRoutes[i].AirRouteLatitude,
                    TurningPointHeight = 1000,
                    TurningPointType = "转运",
                    SegmentFlightFuelConsumption = 3,
                    SegmentFlightTime = 0,
                    RemainingFuel = 0,
                });
            }
        }

        public static void ZhaoShuiJiuYuan1(List<AirRoute> airRoutes, ref List<TurningPoint> turningPoint)
        {
            turningPoint.Add(new TurningPoint
            {
                TurningPointName = "转运",
                TurningPointLongitude = airRoutes[airRoutes.Count - 1].AirRouteLongitude,
                TurningPointLatitude = airRoutes[airRoutes.Count - 1].AirRouteLatitude,
                TurningPointHeight = 1000,
                TurningPointType = "转运",
                SegmentFlightFuelConsumption = 3,
                SegmentFlightTime = 1800,
                RemainingFuel = 0,
            });
        }

        public static void SeaSouJiu(FlightPlanEditor editor, ref List<TurningPoint> turningPoints)
        {
            int i;
            for (i = 0; i < editor.airroute.Length; i++)
            {
                turningPoints.Add(new TurningPoint
                {
                    TurningPointName = "巡航",
                    TurningPointLongitude = editor.airroute[i].AirRouteLongitude,
                    TurningPointLatitude = editor.airroute[i].AirRouteLatitude,
                    TurningPointHeight = 150,
                    TurningPointType = "普通",
                    SegmentFlightFuelConsumption = 3,
                    SegmentFlightTime = 0,
                    RemainingFuel = 0,
                });
            }
        }

        public static void SeaSouJiu2(FlightPlanEditor editor, MissionPoint missionPoint,
            ref List<TurningPoint> turningPoints)
        {
            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "巡航",
                TurningPointLongitude = missionPoint.MissionPointLongitude,
                TurningPointLatitude = missionPoint.MissionPointLatitude,
                TurningPointHeight = 0,
                TurningPointType = "普通",
                SegmentFlightFuelConsumption = 3,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static double CalculateTotalFuelConsumption(FlightPlanEditor editor, List<TurningPoint> turningPoints)
        {
            double initialFuel = editor.aircraftparameter.MaxFuelCapacity; // 起始燃油量
            double totalFuelConsumption = 0; // 总燃油消耗量
            double totalRefuelAmount = 0; // 总加油量

            for (int i = 0; i < turningPoints.Count; i++)
            {
                //// 更新飞行过程中的燃油消耗
                //if (i ==0)
                //{
                //    double segmentFuelConsumed = initialFuel - turningPoints[i].RemainingFuel;
                //}
                //else
                //{
                //    double segmentFuelConsumed = (turningPoints[i - 1].RemainingFuel - turningPoints[i].RemainingFuel);
                //    totalFuelConsumption += segmentFuelConsumed;
                //}

                // 如果当前航路点是加油点，更新燃油并记录加油量
                if (turningPoints[i].TurningPointType == "加油")
                {
                    double refuelAmount = editor.aircraftparameter.MaxFuelCapacity - turningPoints[i - 2].RemainingFuel;
                    totalRefuelAmount += refuelAmount;
                }
            }

            // 最终燃油消耗 = 初始燃油 + 总加油量 - 最终剩余燃油
            double finalFuel = turningPoints.Last().RemainingFuel;
            totalFuelConsumption = (initialFuel + totalRefuelAmount) - finalFuel;

            return totalFuelConsumption;
        }

        public static void LandSouJiu(FlightPlanEditor editor, ref List<TurningPoint> turningPoints)
        {
            int i;
            for (i = 0; i < editor.airroute.Length; i++)
            {
                turningPoints.Add(new TurningPoint
                {
                    TurningPointName = "巡航",
                    TurningPointLongitude = editor.airroute[i].AirRouteLongitude,
                    TurningPointLatitude = editor.airroute[i].AirRouteLatitude,
                    TurningPointHeight = editor.airroute[i].AirRouteHeight,
                    TurningPointType = "普通",
                    SegmentFlightFuelConsumption = 3,
                    SegmentFlightTime = 0,
                    RemainingFuel = 0,
                });
            }
        }

        public static void FromMissionToEnd(FlightPlanEditor editor, MissionEndPoint missionEndPoint,
            ref List<TurningPoint> turningPoints) //生成从任务段终点到基地的航路点
        {
            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "平飞",
                TurningPointLongitude = missionEndPoint.MissionEndPointLongitude,
                TurningPointLatitude = missionEndPoint.MissionEndPointLatitude,
                TurningPointHeight = missionEndPoint.MissionEndPointHeight,
                TurningPointType = "普通",
                SegmentFlightFuelConsumption = 3,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });


            //double k;
            double lat2, lon2;
            lat2 = (turningPoints[^1].TurningPointLatitude + editor.endbase.BaseLatitude) / 2;
            lon2 = (turningPoints[^1].TurningPointLongitude + editor.endbase.BaseLongitude) / 2;
            // k = (turningPoints[^1].TurningPointLatitude - editor.originbase.BaseLatitude) /
            //     (turningPoints[^1].TurningPointLongitude - editor.originbase.BaseLongitude);
            // if (turningPoints[^1].TurningPointLongitude > editor.originbase.BaseLongitude)
            // {
            //     lat2 = 0.08544 * k / (Math.Sqrt(k * k + 1)) + editor.originbase.BaseLatitude;
            //     lon2 = 0.08544 / (Math.Sqrt(k * k + 1)) + editor.originbase.BaseLongitude;
            // }
            // else
            // {
            //     lat2 = editor.originbase.BaseLatitude - 0.08544 * k / (Math.Sqrt(k * k + 1));
            //     lon2 = editor.originbase.BaseLongitude - 0.08544 / (Math.Sqrt(k * k + 1));
            // }

            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "降高",
                TurningPointLongitude = lon2,
                TurningPointLatitude = lat2,
                TurningPointHeight = 2000,
                TurningPointType = "普通",
                SegmentFlightFuelConsumption = 4,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });

            turningPoints.Add(new TurningPoint
            {
                TurningPointName = "返回基地",
                TurningPointLongitude = editor.endbase.BaseLongitude,
                TurningPointLatitude = editor.endbase.BaseLatitude,
                TurningPointHeight = editor.endbase.BaseHeight,
                TurningPointType = "普通",
                SegmentFlightFuelConsumption = 4,
                SegmentFlightTime = 0,
                RemainingFuel = 0,
            });
        }

        public static void InitializeVelocities(FlightPlanEditor editor, List<TurningPoint> turningPoints,
            ref double[] velocitys, double t)
        {
            velocitys[0] = GetClimbVelocity(editor, turningPoints[0].TurningPointHeight, t);
            velocitys[1] = GetCruisingVelocity(editor, turningPoints[1].TurningPointHeight, t);
            velocitys[2] = GetEnduranceVelocity(editor, turningPoints[2].TurningPointHeight, t);
            velocitys[3] = GetDescentVelocity(editor, turningPoints[0].TurningPointHeight, t);
        }


        public static void InitializeFuelConsumptions(FlightPlanEditor editor, List<TurningPoint> turningPoints,
            ref double[] fuelConsumptions, double t)
        {
            fuelConsumptions[0] = GetClimbFuelConsumptionRate(editor, turningPoints[0].TurningPointHeight, t);
            fuelConsumptions[1] = GetCruisingFuelConsumptionRate(editor, turningPoints[1].TurningPointHeight, t);
            fuelConsumptions[2] = GetEnduranceFuelConsumptionRate(editor, turningPoints[2].TurningPointHeight, t);
            fuelConsumptions[3] = GetDescentFuelConsumptionRate(editor, turningPoints[0].TurningPointHeight, t);
            fuelConsumptions[4] = GetHoverFuelConsumptionRate(editor, turningPoints[2].TurningPointHeight, t);
        }

        public static void CalculateTrueHeading(FlightPlanEditor editor, ref List<TurningPoint> turningPoints)
        {
            for (int i = 0; i < turningPoints.Count - 1; i++)
            {
                // 转换为弧度
                double lat1Rad = turningPoints[i].TurningPointLatitude * Math.PI / 180;
                double lon1Rad = turningPoints[i].TurningPointLongitude * Math.PI / 180;
                double lat2Rad = turningPoints[i + 1].TurningPointLatitude * Math.PI / 180;
                double lon2Rad = turningPoints[i + 1].TurningPointLongitude * Math.PI / 180;
                double deltaLon = lon2Rad - lon1Rad;

                double x = Math.Sin(deltaLon) * Math.Cos(lat2Rad);
                double y = Math.Cos(lat1Rad) * Math.Sin(lat2Rad) -
                           Math.Sin(lat1Rad) * Math.Cos(lat2Rad) * Math.Cos(deltaLon);

                // 计算航向角
                double headingRad = Math.Atan2(x, y);

                // 转换为度并标准化
                double headingDeg = headingRad * 180 / Math.PI;
                headingDeg = (headingDeg + 360) % 360;
                turningPoints[i].HeadingAngle = headingDeg;
            }
        }

        public static void FXJHTPDiedai(FlightPlanEditor editor, ref List<TurningPoint> turningPoints,
            double[] velocitys, double[] fuelConsumptions)
        {
            int i;
            double DEG_TO_RAD_LOCAL = 3.1415926535897932 / 180;
            double[] x = new double[turningPoints.Count];
            double[] y = new double[turningPoints.Count];
            double[] z = new double[turningPoints.Count];

            // LLA坐标转换为ECEF坐标
            for (i = 0; i < turningPoints.Count; i++)
            {
                double lon = turningPoints[i].TurningPointLongitude * DEG_TO_RAD_LOCAL;
                double lat = turningPoints[i].TurningPointLatitude * DEG_TO_RAD_LOCAL;
                double hei = turningPoints[i].TurningPointHeight;

                double a = 6378137.0;
                double b = 6356752.31424518;
                double N = a / (Math.Sqrt(1 - ((a * a - b * b) / (a * a)) * Math.Sin(lat) * Math.Sin(lat)));

                x[i] = (N + hei) * Math.Cos(lat) * Math.Cos(lon);
                y[i] = (N + hei) * Math.Cos(lat) * Math.Sin(lon);
                z[i] = ((b * b * N) / (a * a) + hei) * Math.Sin(lat);
            }

            // 计算每个航段的飞行时间
            for (i = 0; i < turningPoints.Count; i++)
            {
                if (turningPoints[i].SegmentFlightTime == 0)
                {
                    double distanceab = 0;
                    if (i != turningPoints.Count - 1)
                    {
                        distanceab = Math.Sqrt(Math.Pow(x[i] - x[i + 1], 2) + Math.Pow(y[i] - y[i + 1], 2) +
                                               Math.Pow(z[i] - z[i + 1], 2));
                    }


                    double velocity;
                    switch (turningPoints[i].SegmentFlightFuelConsumption)
                    {
                        case 1:
                            velocity = velocitys[0];
                            break;
                        case 2:
                            velocity = velocitys[1];
                            break;
                        case 3:
                            velocity = velocitys[2];
                            break;
                        case 4:
                            velocity = velocitys[3];
                            break;
                        case 5:
                            velocity = 0;
                            break;
                        default:
                            velocity = 0;
                            break;
                    }

                    turningPoints[i].SegmentFlightTime = CalculateSegmentFlightTime(distanceab, velocity);

                    double CalculateSegmentFlightTime(double distance, double velocit)
                    {
                        return distance * 3.6 / velocit;
                    }

                    // 打印调试信息
                    //Console.WriteLine($"航段 {i}: 时间 = {turningPoints[i].SegmentFlightTime} s, 速度 = {velocity} km/h, 距离 = {distanceab} m");
                }
                //Console.WriteLine($"航段 {i}: 时间 = {turningPoints[i].SegmentFlightTime} s");


                // 计算燃油消耗，并在燃油不足时插入“返回基地”、“加油”和“返回原航路点”航路点
                if (turningPoints[i].RemainingFuel == 0)
                {
                    double remainingFuel;
                    if (i == 0)
                    {
                        remainingFuel = editor.aircraftparameter.MaxFuelCapacity * 0.8;
                    }
                    else
                    {
                        remainingFuel = turningPoints[i - 1].RemainingFuel;
                    }

                    double fuelConsumption = 0;
                    switch (turningPoints[i].SegmentFlightFuelConsumption)
                    {
                        case 1:
                            fuelConsumption = fuelConsumptions[0];
                            break;
                        case 2:
                            fuelConsumption = fuelConsumptions[1];
                            break;
                        case 3:
                            fuelConsumption = fuelConsumptions[2];
                            break;
                        case 4:
                            fuelConsumption = fuelConsumptions[3];
                            break;
                        case 5:
                            fuelConsumption = fuelConsumptions[4];
                            break;
                        default:
                            fuelConsumption = 0;
                            break;
                    }

                    remainingFuel -= fuelConsumption * turningPoints[i].SegmentFlightTime / 3600;


                    turningPoints[i].RemainingFuel = remainingFuel;
                    // 打印调试信息
                    //Console.WriteLine($"航段 {i}: 油耗率 = {fuelConsumption} kg/h, 剩余燃油 = {turningPoints[i].RemainingFuel} kg");
                }
                //Console.WriteLine($"航段 {i}: 剩余燃油 = {turningPoints[i].RemainingFuel} kg");

                if (turningPoints[i].RemainingFuel < editor.aircraftparameter.MaxFuelCapacity * 0.2 &&
                    !turningPoints[i].IsRefuelPointInserted && i < turningPoints.Count - 2)
                {
                    // 标记当前航路点为已插入加油点
                    turningPoints[i].IsRefuelPointInserted = true;
                    turningPoints[i + 1].IsRefuelPointInserted = true;

                    TurningPoint returnToBase = new TurningPoint
                    {
                        TurningPointName = "返回基地",
                        TurningPointLongitude = editor.fuelbase.BaseLongitude,
                        TurningPointLatitude = editor.fuelbase.BaseLatitude,
                        TurningPointHeight = editor.fuelbase.BaseHeight,
                        TurningPointType = "返航",
                        SegmentFlightTime = 600,
                        SegmentFlightFuelConsumption = 0,
                        RemainingFuel = editor.aircraftparameter.MaxFuelCapacity,
                    };

                    TurningPoint refuelPoint = new TurningPoint
                    {
                        TurningPointName = "加油",
                        TurningPointLongitude = editor.fuelbase.BaseLongitude,
                        TurningPointLatitude = editor.fuelbase.BaseLatitude,
                        TurningPointHeight = editor.fuelbase.BaseHeight,
                        TurningPointType = "加油",
                        SegmentFlightTime = 0,
                        SegmentFlightFuelConsumption = 2,
                        RemainingFuel = 0,
                    };

                    TurningPoint returnToPrevious = new TurningPoint
                    {
                        TurningPointName = "返回原航路点",
                        TurningPointLongitude = turningPoints[i + 1].TurningPointLongitude,
                        TurningPointLatitude = turningPoints[i + 1].TurningPointLatitude,
                        TurningPointHeight = turningPoints[i + 1].TurningPointHeight,
                        TurningPointType = "返航",
                        SegmentFlightTime = 0,
                        SegmentFlightFuelConsumption = 2,
                        RemainingFuel = 0,
                    };

                    // 插入新航路点到当前位置
                    turningPoints.Insert(i + 2, returnToBase);
                    turningPoints.Insert(i + 3, refuelPoint);
                    turningPoints.Insert(i + 4, returnToPrevious);

                    // 重新计算插入的航路点的飞行时间和燃油消耗
                    FXJHTPDiedai(editor, ref turningPoints, velocitys, fuelConsumptions);

                    // 退出当前方法，避免重复计算

                    return;
                }
            }
        }


        /// <summary>
        /// 巡护用
        /// </summary>
        /// <param name="turningPoints"></param>
        /// <param name="editor"></param>
        /// <param name="nowtime"></param>
        /// <returns></returns>
        public static (CurrentLocation, bool) GetCurrentLocation(List<TurningPoint> turningPoints,
            FlightPlanEditor editor,
            double nowtime)
        {
            CurrentLocation currentLocation = new CurrentLocation();

            double[] timetable = new double[editor.airroute.Length + 2]; //airroute.Length表示巡护航线中有几个航路点
            timetable[0] = 0; //设起飞时刻为0
            int segmentnumber = -1;
            int i;
            for (i = 0; i < editor.airroute.Length + 1; i++)
            {
                timetable[i + 1] = timetable[i] + turningPoints[i].SegmentFlightTime;
            }

            for (i = 0; i < editor.airroute.Length + 2; i++)
            {
                if ((nowtime - timetable[i]) >= 0)
                {
                    segmentnumber += 1;
                }
                else
                {
                    break;
                }
            }

            bool isEnd = false || segmentnumber >= turningPoints.Count;

            currentLocation.CurrentLon = turningPoints[segmentnumber].TurningPointLongitude +
                                         (turningPoints[segmentnumber + 1].TurningPointLongitude -
                                          turningPoints[segmentnumber].TurningPointLongitude) *
                                         (nowtime - timetable[segmentnumber]) /
                                         turningPoints[segmentnumber].SegmentFlightTime;
            currentLocation.CurrentLat = turningPoints[segmentnumber].TurningPointLatitude +
                                         (turningPoints[segmentnumber + 1].TurningPointLatitude -
                                          turningPoints[segmentnumber].TurningPointLatitude) *
                                         (nowtime - timetable[segmentnumber]) /
                                         turningPoints[segmentnumber].SegmentFlightTime;
            currentLocation.CurrentHei = turningPoints[segmentnumber].TurningPointHeight +
                                         (turningPoints[segmentnumber + 1].TurningPointHeight -
                                          turningPoints[segmentnumber].TurningPointHeight) *
                                         (nowtime - timetable[segmentnumber]) /
                                         turningPoints[segmentnumber].SegmentFlightTime;
            currentLocation.CurrentFuel = 0;
            currentLocation.Currentvelo = 0;
            currentLocation.Currentsegnum = segmentnumber + 1;
            currentLocation.CurrentCourse = 75;

            return (currentLocation, isEnd);
        }

        //改
        /// <summary>
        /// 计算当前位置
        /// </summary>
        /// <param name="FXJHTP"></param>
        /// <param name="FXJHTPLength"></param>
        /// <param name="nowtime"></param>
        /// <returns></returns>
        // public static (CurrentLocation, bool, int)
        //     GetAllCurrentLocation(List<TurningPoint> turningPoints, double nowtime) //飞机实时位置打印
        // {
        //     CurrentLocation currentLocation = new CurrentLocation();
        //     double[] timetable = new double[turningPoints.Count + 1];
        //     timetable[0] = 0;
        //     int segmentnumber = -1;
        //     int i;
        //     for (i = 0; i < turningPoints.Count; i++)
        //     {
        //         timetable[i + 1] = timetable[i] + turningPoints[i].SegmentFlightTime;
        //     }
        //
        //     for (i = 0; i < turningPoints.Count + 1; i++)
        //     {
        //         if ((nowtime - timetable[i]) >= 0)
        //         {
        //             segmentnumber += 1;
        //         }
        //         else
        //         {
        //             break;
        //         }
        //     }
        //
        //     bool isEnd = false || segmentnumber >= turningPoints.Count;
        //
        //     currentLocation.Currentsegnum = segmentnumber;
        //     if (segmentnumber < turningPoints.Count - 1)
        //     {
        //         currentLocation.CurrentLon = turningPoints[segmentnumber].TurningPointLongitude +
        //                                      ((turningPoints[segmentnumber + 1].TurningPointLongitude -
        //                                        turningPoints[segmentnumber].TurningPointLongitude) /
        //                                       turningPoints[segmentnumber].SegmentFlightTime) *
        //                                      (nowtime - timetable[segmentnumber]);
        //         currentLocation.CurrentLat = turningPoints[segmentnumber].TurningPointLatitude +
        //                                      ((turningPoints[segmentnumber + 1].TurningPointLatitude -
        //                                        turningPoints[segmentnumber].TurningPointLatitude) /
        //                                       turningPoints[segmentnumber].SegmentFlightTime) *
        //                                      (nowtime - timetable[segmentnumber]);
        //         currentLocation.CurrentHei = turningPoints[segmentnumber].TurningPointHeight +
        //                                      ((turningPoints[segmentnumber + 1].TurningPointHeight -
        //                                        turningPoints[segmentnumber].TurningPointHeight) /
        //                                       turningPoints[segmentnumber].SegmentFlightTime) *
        //                                      (nowtime - timetable[segmentnumber]);
        //         currentLocation.CurrentFuel = turningPoints[segmentnumber].RemainingFuel -
        //                                       turningPoints[segmentnumber].SegmentFlightFuelConsumption *
        //                                       (nowtime - timetable[segmentnumber]);
        //         currentLocation.PresentMission = turningPoints[segmentnumber].TurningPointName;
        //     }
        //     else if (segmentnumber == turningPoints.Count - 1)
        //     {
        //         currentLocation.CurrentLon = turningPoints[segmentnumber].TurningPointLongitude +
        //                                      ((turningPoints[0].TurningPointLongitude -
        //                                        turningPoints[segmentnumber].TurningPointLongitude) /
        //                                       turningPoints[segmentnumber].SegmentFlightTime) *
        //                                      (nowtime - timetable[segmentnumber]);
        //         currentLocation.CurrentLat = turningPoints[segmentnumber].TurningPointLatitude +
        //                                      ((turningPoints[0].TurningPointLatitude -
        //                                        turningPoints[segmentnumber].TurningPointLatitude) /
        //                                       turningPoints[segmentnumber].SegmentFlightTime) *
        //                                      (nowtime - timetable[segmentnumber]);
        //         currentLocation.CurrentHei = turningPoints[segmentnumber].TurningPointHeight +
        //                                      ((turningPoints[0].TurningPointHeight -
        //                                        turningPoints[segmentnumber].TurningPointHeight) /
        //                                       turningPoints[segmentnumber].SegmentFlightTime) *
        //                                      (nowtime - timetable[segmentnumber]);
        //         currentLocation.CurrentFuel = turningPoints[segmentnumber].RemainingFuel -
        //                                       turningPoints[segmentnumber].SegmentFlightFuelConsumption *
        //                                       (nowtime - timetable[segmentnumber]);
        //         currentLocation.PresentMission = turningPoints[segmentnumber].TurningPointName;
        //     }
        //     else
        //     {
        //         currentLocation.CurrentLon = turningPoints[^1].TurningPointLongitude;
        //         currentLocation.CurrentLat = turningPoints[^1].TurningPointLatitude;
        //         currentLocation.CurrentHei = turningPoints[^1].TurningPointHeight;
        //         currentLocation.Currentvelo = 0;
        //         currentLocation.CurrentFuel = turningPoints[segmentnumber - 1].RemainingFuel -
        //                                       turningPoints[segmentnumber - 1].SegmentFlightFuelConsumption *
        //                                       turningPoints[segmentnumber - 1].SegmentFlightTime;
        //         currentLocation.PresentMission = turningPoints[segmentnumber - 1].TurningPointName;
        //
        //         isEnd = true;
        //     }
        //
        //     return (currentLocation, isEnd, segmentnumber);
        // }

        public static List<List<Point3D>> StoreFlightPaths(ref List<TurningPoint> turningPoints,
            List<Point3D> areaPoints)
        {
            List<List<Point3D>> allPaths = new List<List<Point3D>>();

            for (int i = 0; i < turningPoints.Count - 1; i++)
            {
                var start = turningPoints[i];
                var end = turningPoints[i + 1];
                List<Point3D> path;

                if (start.TurningPointLongitude == end.TurningPointLongitude &&
                    start.TurningPointLatitude == end.TurningPointLatitude)
                {
                    // 经纬度相同，直接存储起点和终点
                    path = new List<Point3D>
                    {
                        new Point3D
                        {
                            Lon = start.TurningPointLongitude, Lat = start.TurningPointLatitude,
                            Z = start.TurningPointHeight
                        },
                        new Point3D
                        {
                            Lon = end.TurningPointLongitude, Lat = end.TurningPointLatitude, Z = end.TurningPointHeight
                        }
                    };
                }
                else
                {
                    var start3D = new Point3D
                    {
                        Lon = start.TurningPointLongitude, Lat = start.TurningPointLatitude,
                        Z = start.TurningPointHeight
                    };
                    var end3D = new Point3D
                        { Lon = end.TurningPointLongitude, Lat = end.TurningPointLatitude, Z = end.TurningPointHeight };

                    // 调用路径规划方法
                    path = FlightPlanner.PlanFlightPath(start3D, end3D, areaPoints);

                    // 创建新的路径列表
                    // List<Point3D> adjustedPath = new List<Point3D>();
                    //
                    // // 添加第一个点
                    // adjustedPath.Add(new Point3D
                    // {
                    //     Lon = path[0].Lon,
                    //     Lat = path[0].Lat,
                    //     Z = path[0].Z
                    // });
                    //
                    // // 遍历路径中间点
                    // for (int j = 1; j < path.Count - 1; j++)
                    // {
                    //     adjustedPath.Add(new Point3D
                    //     {
                    //         Lon = path[j].Lon,
                    //         Lat = path[j].Lat,
                    //         Z = path[j].Z + 300 // 加300
                    //     });
                    // }
                    //
                    // // 添加最后一个点
                    // adjustedPath.Add(new Point3D
                    // {
                    //     Lon = path[path.Count - 1].Lon,
                    //     Lat = path[path.Count - 1].Lat,
                    //     Z = path[path.Count - 1].Z
                    // });

                    allPaths.Add(path);
                }
            }

            return allPaths;
        }


        public static  CurrentLocation GetCurrentLocationNew(List<TurningPoint> turningPoints,
            List<List<Point3D>> allPaths, double currentTime)
        {
            double accumulatedTime = 0; // 累积飞行时间
            CurrentLocation currentLocation = new CurrentLocation();

            for (int i = 0; i < turningPoints.Count - 1; i++)
            {
                TurningPoint startPoint = turningPoints[i];
                double segmentTime = startPoint.SegmentFlightTime;

                if (currentTime >= accumulatedTime && currentTime <= accumulatedTime + segmentTime)
                {
                    // 当前时间在这个航路段中，找到对应路径
                    List<Point3D> pathSegment = allPaths[i];

                    // 计算该航段的飞行进度
                    double timeInSegment = currentTime - accumulatedTime;
                    double progress = timeInSegment / segmentTime; // 当前航段内的总进度比例

                    // 根据进度计算当前路径段的位置
                    double totalDistance = 0;
                    List<double> distances = new List<double>();

                    // 计算路径段的总距离及每两个点之间的距离
                    for (int j = 0; j < pathSegment.Count - 1; j++)
                    {
                        double distance = CalculateDistance(pathSegment[j], pathSegment[j + 1]);
                        distances.Add(distance);
                        totalDistance += distance;
                    }

                    // 找到当前进度在总路径中的距离
                    double targetDistance = totalDistance * progress;
                    double accumulatedDistance = 0;

                    // 遍历路径段，找到当前进度对应的两个点之间
                    for (int j = 0; j < pathSegment.Count - 1; j++)
                    {
                        accumulatedDistance += distances[j];
                        if (accumulatedDistance >= targetDistance)
                        {
                            // 线性插值计算当前位置
                            double segmentProgress =
                                (targetDistance - (accumulatedDistance - distances[j])) / distances[j];
                            Point3D currentPointStart = pathSegment[j];
                            Point3D currentPointEnd = pathSegment[j + 1];

                            currentLocation.CurrentLon = currentPointStart.Lon +
                                                         (currentPointEnd.Lon - currentPointStart.Lon) *
                                                         segmentProgress;
                            currentLocation.CurrentLat = currentPointStart.Lat +
                                                         (currentPointEnd.Lat - currentPointStart.Lat) *
                                                         segmentProgress;
                            currentLocation.CurrentHei = currentPointStart.Z +
                                                         (currentPointEnd.Z - currentPointStart.Z) * segmentProgress;

                            // 设置当前航段数，从0开始计数
                            currentLocation.Currentsegnum = i; // 使用TurningPoint列表的索引
                            return currentLocation;
                        }
                    }
                }

                accumulatedTime += segmentTime;
            }

            // 如果超过总飞行时间，返回最后一个点的位置
            List<Point3D> lastPath = allPaths.Last();
            Point3D lastPoint = lastPath.Last();
            currentLocation.CurrentLon = lastPoint.Lon;
            currentLocation.CurrentLat = lastPoint.Lat;
            currentLocation.CurrentHei = lastPoint.Z;

            // 设置当前航段数为最后一个TurningPoint的索引
            currentLocation.Currentsegnum = turningPoints.Count - 1;
            currentLocation.EndLocation = true;
            return currentLocation;
        }

        // 计算两个点之间的距离
        private static double CalculateDistance(Point3D p1, Point3D p2)
        {
            return Math.Sqrt(Math.Pow(p2.Lon - p1.Lon, 2) + Math.Pow(p2.Lat - p1.Lat, 2) + Math.Pow(p2.Z - p1.Z, 2));
        }
    }
}