SimulationServer/SimulationServer/Entity/AircraftZS.cs

using KYFramework;
using Model;
using SimulationServer.Utils;
using Define = SimulationServer.Utils.Define;

namespace SimulationServer;

public class AircraftZS : AircraftEntity
{
    public string NextMissionId; // 下一个任务ID
    public MissionEndPoint missionEndPoint = new MissionEndPoint();

    public int LandingPersonnel; //personCount
    public MHRescueMission mhRescueMission;

    public int 单次救援人数 = 80; // 任务文件读取
    public int 观察盘旋圈数 = 3; //任务文件读取

    public int landingPoint = 0;

    public List<AirRoute> airRoutes = new List<AirRoute>();

    public override void End()
    {

    }

    public override void Reset()
    {
        base.Reset();
    }
    public override void Start()
    {
        FXJHGenerate.FromStartToMission(FlightPlanEditor, ref TurningPoints);//生成从起点到任务段起点的航路点

        missionEndPoint.MissionEndPointLatitude = FlightPlanEditor.targetpoint[0].TargetPointLatitude;
        missionEndPoint.MissionEndPointLongitude = FlightPlanEditor.targetpoint[0].TargetPointLongitude;
        missionEndPoint.MissionEndPointHeight = FlightPlanEditor.targetpoint[0].TargetPointHeight;

        List<double> list = GenerateCircleTrajectory(FlightPlanEditor.targetpoint[0].TargetPointLatitude, FlightPlanEditor.targetpoint[0].TargetPointLongitude, 1, 360);
        //airRoutes = list

        for (int i = 0; i < 观察盘旋圈数; i++)
        {
            FXJHGenerate.ZhaoShuiJiuYuan(airRoutes, ref TurningPoints);

        }
        // FXJHGenerate.InitializeVelocities(FlightPlanEditor, TurningPoints, ref Velocitys);
        // FXJHGenerate.InitializeFuelConsumptions(FlightPlanEditor, TurningPoints,ref FuelConsumptions);

        FXJHGenerate.FromMissionToEnd(FlightPlanEditor, missionEndPoint, ref TurningPoints);
        FXJHGenerate.FXJHTPDiedai(FlightPlanEditor, ref TurningPoints, Velocitys, FuelConsumptions); // 更新了 计算油耗的方法
    }

    // centerLat centerLon 想定里目标点的经纬度 radiusKm = 1 numPoints = 360  返回的airRoutes  // 

    // 生成圆形轨迹点，并以 double 列表形式返回（按经度-纬度顺序存储）
    public static List<double> GenerateCircleTrajectory(double centerLat, double centerLon, double radiusKm, int numPoints)
    {
        var points = new List<double>();
        double earthRadius = 6371.0; // 地球半径，单位：公里

        for (int i = 0; i < numPoints; i++)
        {
            double angle = 2 * Math.PI * i / numPoints;  // 当前点的角度（弧度）

            // 计算偏移量
            double offsetLat = radiusKm / earthRadius; // 纬度的偏移量（弧度）
            double offsetLon = offsetLat / Math.Cos(ToRadians(centerLat)); // 经度的偏移量（弧度）

            // 计算该角度下的点的经纬度
            double newLat = centerLat + ToDegrees(offsetLat * Math.Cos(angle));
            double newLon = centerLon + ToDegrees(offsetLon * Math.Sin(angle));

            // 按经度在前，纬度在后顺序存储
            points.Add(newLon);
            points.Add(newLat);
        }

        return points;
    }

    // 弧度转换为角度
    static double ToDegrees(double radians)
    {
        return radians * 180.0 / Math.PI;
    }

    // 角度转换为弧度
    static double ToRadians(double degrees)
    {
        return degrees * Math.PI / 180.0;
    }

    //private double GetDistance(double lon1, double lon2, double lat1, double lat2)
    //{
    //    double R = 6371; // 地球的半径（公里）
    //    double dLat = (lat2 - lat1) * Math.PI / 180.0;
    //    double dLon = (lon2 - lon1) * Math.PI / 180.0;
    //    double a = Math.Sin(dLat / 2) * Math.Sin(dLat / 2) +
    //               Math.Cos(lat1 * Math.PI / 180.0) * Math.Cos(lat2 * Math.PI / 180.0) *
    //               Math.Sin(dLon / 2) * Math.Sin(dLon / 2);
    //    double c = 2 * Math.Atan2(Math.Sqrt(a), Math.Sqrt(1 - a));
    //    double distance = R * c;

    //    return distance;
    //}

    public override void Update(double time)
    {

    }
}


[ObjectSystem]
public class AircraftZSAwakeSystem : AwakeSystem<AircraftZS, FlightPlanEditor>
{
    public override void Awake(AircraftZS self, FlightPlanEditor flightPlanEditor)
    {
        self.FlightPlanEditor = flightPlanEditor;
        self.Awake();
        self.Reset();
    }
}