46 lines
2.1 KiB
C#
46 lines
2.1 KiB
C#
|
using System;
|
|||
|
|
using System.IO;
|
|||
|
|
|
|||
|
|
namespace TrajectoryOutputDemo;
|
|||
|
|
|
|||
|
|
/// <summary>Trajplanner_output 控制台入口；只输出规划诊断、轨迹摘要和 CSV 路径。</summary>
|
|||
|
|
internal static class Program
|
|||
|
|
{
|
|||
|
|
private static int Main(string[] args)
|
|||
|
|
{
|
|||
|
|
if (args.Length != 0)
|
|||
|
|
{
|
|||
|
|
Console.Error.WriteLine("用法：dotnet run --project TrajectoryOutputDemo.csproj");
|
|||
|
|
return 2;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
string csvPath = Path.Combine(AppContext.BaseDirectory, "output", "trajectory.csv");
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
TrajectoryOutputDemoResult result = new TrajectoryOutputDemoRunner().Run(
|
|||
|
|
TrajectoryOutputDemoConfiguration.CreateDefault(csvPath));
|
|||
|
|
if (!result.Succeeded || result.Trajectory == null || result.ControlTrajectory == null || result.CsvPath == null)
|
|||
|
|
{
|
|||
|
|
Console.Error.WriteLine(result.Diagnostic);
|
|||
|
|
return 1;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
ControlTrajectoryPoint first = result.ControlTrajectory.Points[0];
|
|||
|
|
ControlTrajectoryPoint last = result.ControlTrajectory.Points[result.ControlTrajectory.Points.Count - 1];
|
|||
|
|
Console.WriteLine("轨迹 ID：" + result.Trajectory.Metadata.TrajectoryId);
|
|||
|
|
Console.WriteLine("生效时间：" + result.Trajectory.Metadata.EffectiveAtUtc.ToString("O"));
|
|||
|
|
Console.WriteLine("方向段：" + result.Trajectory.Metadata.SegmentIndex + "，终端类型：" + result.Trajectory.Metadata.TerminalType);
|
|||
|
|
Console.WriteLine("轨迹点数：" + result.ControlTrajectory.Points.Count);
|
|||
|
|
Console.WriteLine("首点：t=" + first.TimeFromStartSeconds + "s, X=" + first.XMeters + "m, Y=" + first.YMeters + "m");
|
|||
|
|
Console.WriteLine("末点：t=" + last.TimeFromStartSeconds + "s, X=" + last.XMeters + "m, Y=" + last.YMeters + "m");
|
|||
|
|
Console.WriteLine("CSV：" + result.CsvPath);
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
catch (Exception exception)
|
|||
|
|
{
|
|||
|
|
Console.Error.WriteLine("轨迹 Demo 运行异常：" + exception.Message);
|
|||
|
|
return 1;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|